


前 言 


PID 控制 足 最 早 发 展 起 来 的 控制 策略 之 …， 由 于 其 算法 简单 、 鲁 棒 性 好 及 可 靠 性 高 ， 被 
上 六 泛 应 用 于 过 程控 制 和 运动 控制 中 ， 尤 其 适用 于 可 建立 精确 数学 模型 的 确定 性 系统 。 然 而 实 
际 工业 和 牛 产 过 程 往 往 具 有 非 线性 、 时 变 不 确定 性 ， 难 以 建立 精确 的 数学 模型 ， 应 用 常规 PID 
控制 器 不 能 达到 理想 的 控制 效果 ， 而 且 在 实际 生产 现场 中 ， 由 于 受到 参数 整定 方法 繁杂 的 困 
扰 ， 常 规 PID 控制 器 参数 往往 整定 不 良 、 性 能 欠 佳 ， 对 运行 工 况 的 适应 性 很 差 。 

计算 机 技术 和 智能 控制 理论 的 发 展 为 复杂 动态 不 傅 定 系统 的 控制 提供 了 新 的 途径 。 采 用 
智能 控制 技术 ， 可 设计 知 能 PID 和 进行 PID 的 智能 疼 定 。 

有 关 智 能 PID 控制 等 新 型 PID 控制 理 沦 及 其 工程 应 骨 ， 近 年 来 已 有 大 基 的 论文 发 表 。 作 
者 多 年 米 一 直 从 事 智能 控制 方面 的 研究 和 教学 工作 , 为 了 促进 PID 控制 和 自动 化 技术 的 进步 ， 
反映 PID 控制 设计 与 应 用 中 的 最 新 研究 成 果 ， 并 使 广大 工程 技术 人 员 了 解 、 掌 所 和 应 用 这 一 
领域 的 最 新 技术 ， 学 会 用 MATLAB 语言 进行 PID 控制 器 的 设计 ， 作 者 编写 了 这 本 书 ， 以 抛 
砖 引 玉 ， 供 广大 读者 学 习 参 考 。 

本 书 是 在 总 结 作者 多 年 研究 成 果 的 基础 上 ， 进 一 步 理 论 化 、 系 统 化 、 规 范 化 、 实 用 化 而 
成 的 ， 其 特点 如 下 : 

《1)》 PID 控制 算法 取材 新 颖 。 内 容 先进 ， 重 点 置 于 学 科 交 叉 部 分 的 前 沿 研究 和 介绍 一 些 
有 潜力 的 新 思想 、 新 方法 和 新 技术 ， 取 材 着 重 于 基 木 概念 、 基 本 理论 和 基本 方法 。 

(2) 针对 每 种 PID 算法 给 出 完整 的 MATLAB 仿真 程序 。 这 些 程序 都 可 以 在 线 运行 ， 并 
给 出 程序 的 说 明和 仿真 结果 。 具 有 很 强 的 可 读 性 ， 很 容易 转化 为 其 他 各 种 实用 语言 。 

(3) 着 重 从 应 用 领域 角度 出 发 ， 突 出 理论 联系 实际 ， 面 向 广大 工程 技术 人 员 ， 具 有 很 强 
的 工程 性 和 实用 性 。 书 中 有 人 量 应 用 实例 太 其 结果 分 析 ， 为 读者 提供 了 有 益 的 借鉴 。 

(4) 所 给 出 的 各 种 PID 算法 完整 ， 种 序 设 计 、 结 构 设 计 力 求 简单 明了 ， 便 于 自学 和 进 一 
步 开 发 。 

本 书 其 分 11 章 。 第 1 章 介绍 连续 系统 PID 控制 和 离散 系统 数字 PED 控制 的 几 种 基本 方 
法 ， 通 过 仿 趴 和 分 析 进 行 了 说 明 。 第 2 章 介绍 常用 的 数字 PID 控制 系统 ， 主 要 包括 串 级 计算 
机 控制 系统 的 PID 控制 、 纯 滞后 控制 系统 Dahlin 算法 和 基于 Smith 预 估 的 PID 控制 。 第 3 章 
兰 明 专 家 PID 和 模糊 PID 整定 的 基本 算法 和 程序 设计 方法 , 其中 模糊 PID 包 插 模糊 自 适应 整 
定 PID 控制 和 模糊 免疫 PID 控制 算法 , 并 进行 了 仿真 分 析 。 第 4 章 介 绍 神经 PID 的 几 各 方法， 
包括 单 神经 网 络 PID 的 设计 、 神 经 网 络 并 行 PID 控制 、PID 的 几 种 神经 网 络 整定 方法 ， 并 通 
过 仿真 进行 说 明 。 第 5 章 引 入 某 于 遗传 算法 的 PID 控制 ， 主 要 包括 基于 遗传 算法 整定 的 PID 
控制 和 革 于 遗传 算法 摩擦 模型 参数 辩 识 的 PLD 控制 第 6 章 介 绍 多 变量 PID 控制 的 几 种 方法 ， 
主要 包括 PID 控制 、 单 神经 元 PID 控制 和 基于 DRNN 神经 网 络 整定 的 PID 控制 。 第 7 章 半 
述 几 种 先进 的 PID 控制 算法 ， 包 括 某 于 干扰 观 测 器 的 PID 锭 棒 控制 、 基 于 NCD 优化 的 非 线 
性 PID 控制 、 非 线性 参数 必定 的 PID 控制 、 基 于 重复 控制 的 PID 高 精度 控制 、 基 于 零 相 差 前 
簿 补偿 的 PID 控制 和 基于 卡尔 曼 滤波 的 PID 控制 ， 每 种 方法 部 通过 仿真 程序 进行 说 明 。 第 8 
章 介绍 灰色 PID 控制 算法 和 仿真 方法 ， 包 括 基 于 连续 系统 的 灵 色 PID 控制 和 基于 离散 系统 的 
灰色 PID 控制 。 第 9 章 引 入 合 服 系统 的 PID 控制 ,包括 伺服 系统 在 低速 摩擦 条 件 下 的 PID 控 
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制 、 单 质量 伺服 系统 PID 控制 和 二 质 重 何 服 系统 


PID 控制 ， 并 进行 了 仿真 说 明 。 第 10 章 介 


绍 PID 在 机 器 人 控制 中 的 应 用 实例 ， 包 招 确 定性 单 辟 机械手 、 不 确定 性 单 冉 机 械 羊 、N 关节 
机 器 人 的 PID 控制 .第 11 章 阐 述 PID 在 实时 控制 中 的 应 用 实例 , 并 给 出 PID 控制 的 MATLAB 


程序 和 相应 的 Borland C++ 语言 实时 控制 程序 。 








本 书 是 基于 MATLAB 环境 下 开发 的 ， 各 个 章节 的 内 容 具 有 很 强 的 独立 性 ， 读 者 可 以 结 


合 自 己 的 方向 深入 地 进行 研究 。 
本 书 第 2 版 在 第 1 版 的 基础 上 主要 增加 了 以 


内 容 : 基于 $ 函数 的 连续 系统 Simulink 仿 


真 ; 基于 $ 函数 的 离散 系统 Simulink 仿真 ， 基 于 一 种 离散 微分 -跟踪 器 的 PID 控制 ， 基 于 
Ziegler-Nichols 方法 的 PID 整定 ， 基 于 Hopfield 神经 网 络 的 PID 控制 ， 模糊 RBF 网 络 的 PID 


整定 ， 实 时 遗传 算法 优化 的 PID 控制 ; 基于 Anti 
调节 的 模型 参考 自 适 应 控制 。 并 增加 了 新 的 一 章 : 


现 的 程序 进行 了 Simulink 设计 ， 并 针对 第 1 版 中 的 某 些 错误 进行 了 修改 。 


-windup 的 FID 控制 ， 基于 PD 增益 自 适应 
机 器 人 PID 控制 。 针 对 某 些 以 M 语言 实 
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基于 DRNN 神经 网 络 整定 的 PID 控 表 
6.3.1 其 于 DRNN 神经 网 络 参 数 自 学 习 PID 控制 原理 
6.3.2 DRNN 神经 网 络 的 Jacobian 信息 辩 识 
6.3.3 仿真 程序 及 分 析 


几 种 先进 PiD 控制 方法 eeeeeeeeeoeeeeeeeeee 


基于 于 - 扰 观 测 器 的 PID 控制 
7.1.1 “干扰 观测 器 设计 原理 … 
7.1.2 ”连续 系统 的 控制 仿真 
7.1.3 ”离散 系统 的 控制 仿真 … 
非 线性 系统 的 PID 鲁 棒 控 制 
7.2.1 拖 于 NCD 优化 的 非 线 忻 优化 PID 控制 
7.2.2 ， 基 十 NCD 与 优化 耻 数 结合 的 非 线 性 优化 PID 控制 
一 类 非 线 | 性 PID 控制 器 设计 Ce 
7.3.1 ， 非 线性 控制 器 设计 原理 

























































基于 
3.4.1 重复 控制 原理 
7.4.2 ”基于 重复 控制 补偿 的 PID 控制 
7.4.3 ”信和 贞 程序 及 分 析 
基于 堆 相 差 前 馈 补 偿 的 PID 控制 
3.5.] ， 肥 相 差 控制 原理 … 
7.5.2 ”基于 零 相 阐 前 饥 补 偿 的 PID 控制 
7.5.3 ”仿真 程序 帮 分 析 
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7.6 


了 7.7 


7.8 


7.9 


7.10 ”基于 PD 增益 请 适应 调节 的 模型 参考 自 适应 控制 


8.2 


8.3 


8.4 


9.1 


基于 卡尔 曼 滤 波 器 的 PID 控制 
37.6.1 卡尔 曼 滤 波 嵌 原 邮 | 
7.6.2 ”仿真 程序 及 分 析 
3.6.3 基 十 卡尔 冯 滤 波 器 的 PID 搁 
7.6.4 仿真 程序 及 分 析 … 
单 级 倒立 控 的 PLD 控制 
?3.7.1 ， 单 级 倒立 摆 建 模 
7.7.2，” 单 级 倒立 择 控 制 
7.7.3 ”仿真 程序 用 分 析 
吊车 - 双 抽 系统 的 控制 
37.8.1 吊车 - 双 摆 系统 的 建 模 
7.8.2 前 东 - 双 摧 系 统 的 念 上 
基于 Anati-windup 的 PID 控制 
7.9.1 Anti-windup 的 基本 原 旺 
7.9.2 ” 仿 丰 程序 及 分 析 




































74104 控制 器 前 设计 
7.10.2 稳定 性 分 析 …… 
7.10.3 ”仿生 称 序 及 分 析 


灰色 控制 原理 
8.1.1 后 成 数列 
8.1.2 GM 异型 … 
了 扰 依 号 的 灰色 估计 
8.2.1 火 色 估计 的 理论 茶 全 
8%.2.2 ”仿真 实例 
灰色 PID 控制 
8.3.1 灵 色 PID 控制 的 霸 论 基 饥 
8.3.2 ”连续 系统 灰色 PID 控制 … 
8.3.3 ” 仿 丰 程 序 及 分 析 … 
8.3.4 ”离散 系统 灰色 PID 控制 
8.3.5 仿真 程序 必 分 析 “ 
灰色 PID 的 位 置 跟 跳 
8.4.1 连续 系统 灰色 PID 位 置 跟踪 
8.4.2 ”仿真 程序 太 分 析 …… 
8.4.3 ”离散 系统 灰色 PID 位 普 跟 | 
8.44 仿 所 程序 及 分 析 …… 


伺服 系统 PID 控制 ee 
是 于 Lugre 摩 探 模型 的 PID 控制 
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10.1 


10.2 ”不 确定 性 单 恬 机械手 的 PD+ 前 馈 控 


10.3 ”不 确定 性 单 臂 机 械 手 的 PD 和 鲁 棒 控制 


10.4 基于 PD 的 N 关节 机 器 人 控制 ， 


10.5 机 器 人 的 鲁 棒 自 适应 PD 控制 … 


9.1.1 们 服 系统 的 摩擦 现象 … 
9.1.2 ”伺服 系统 的 Lugre 志 控 模型 
1.3 仿真 称 序 必 分 析 

基于 Stribeck 座 控 校 昌 的 了 PID 控制 
9.2.1 Stribeck 摩 探 错 型 撒 述 
9.2.2 一 个 典型 伺服 系 纺 捞 述 
9.2.3 ”仿真 程序 故 分析 
何 服 系统 三 环 的 PID 控制 
9.3.1 何 服 系 
9.3.2 ” 仿 贞 称 上 
二 质量 何 服 系统 的 PID 控制 …… 
9.4.1 …… 质 若 何 服 系统 的 PIP 控制 原理 
9.4.2， 仿 贞 程 序 及 分 析 ……P 
伺服 系统 的 模拟 PD+ 数 字 前 馈 控 制 
9.5.1， 何 服 系统 的 模拟 PD+ 数 字 前 馈 控 
9.5.2 ”仿真 程序 及 分 本 


机 器 人 的 PID 控制 
确定 性 单 占 机 械 手 的 PD+ 前 馈 控 
10.1.1 单 辟 机 械 于 的 运动 方程 


10.1.2 ”以 制品 的 设计 
10.1.3 ”仿真 程序 及 分 析 
































j 原 还 





















10.2.1 不 确定 性 单 虎 机 械 手 的 运动 方程 …… 
10.2.2 ”仿真 程序 及 分 析 








10.3.1 控制 器 设计 … 
10.3.2 ”稳定 性 分 析 “ 
i0.3.3 ”仿真 程 序 及 分 析 














10.4.1 条 关节 机 器 人 运动 方程 
10.42 ，PD 控制 人 

10.43 bD 控制 + 前 馈 控 制 
10.4.4。PD 控制 + 修正 前 锁 控 制 
10.4.5 仿 上 程序 及 分 析 





10.5.! ”机 器 人 动力 学 模型 及 其 结构 特性 
10.5.2 ”控制 器 的 设计 
10.5.3 ”仿真 程序 及 分 析 
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111 


PID 实时 控制 的 C++ 语 


M 语言 的 C++ 转化 … 





11.2 基于 C++ 的 一 - 示 飞 行 模拟 转生 


11.2.1 控制 系统 构成 


11.2.2 实时 控制 程序 分 析 


11.2.3 仿真 程序 及 分 析 


僻 服 系统 PID 实时 控制 
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第 1 章 数字 PID 控制 


自从 计算 机 进入 控制 领域 以 来 ， 用 数字 计算 机 代理 模拟 计算 机 调节 器 组 成 计算 机 控制 系 
统 ， 不 仅 可 以 用 软件 实现 PID 控制 算法 ， 而 且 可 以 利用 计算 机 的 迎 辑 功能， 使 FID 控制 更 加 
灵活 。 数 字 PID 控制 在 生产 过 程 中 是 一 种 最 普遍 采用 的 控制 方法 ， 在 机 电 、 治 金 、 机 械 、 化 
工 等 行业 中 获得 了 广泛 的 应 用 。 将 偏差 的 比例 (P)、 积 分 〈ID) 和 微分 〈D) 通过 线性 组 合 构 
成 控制 量 ， 对 被 控 对 象 进行 控 制 ， 故 称 PID 控制 器 。 

















11 PID 控制 原理 
在 模拟 控制 系统 中 ， 控 制 器 最 常用 的 控制 规律 是 PID 控制 。 民 拟 PID 控制 系统 原理 框图 
如 图 1-1 所 示 。 系 统 由 模拟 PID 控制 器 和 被 控 对 象 组 成 。 


广 -一 盖 | 比例 


TD_ 二 youtt 昌 
机 闻 | 王 分 -人 >| 被 控 对 象 


全 





















































| 积分 











图 1-1 模拟 PID 控制 系统 原理 框图 
PID 控制 器 是 一 种 线性 控制 器 , 它 根据 给 定 值 rin(g) 与 实际 输出 值 yout(fb) 构成 控制 偏差 : 


error( 刀 =rin( 妇 一 Yout( 《1.1) 
PID 的 控制 规律 为 : 
1 rr TDpderror (好 
MI)= |em (9 -eroarzeea ] (1L2) 
或 写成 传递 函数 的 形式 : 
CS) 王 
一- 一 一 一 一 一 1.3 
GD) 互信 于 庆 + 《1.37》 


式 中 ， 太 一 一 比例 系数 ， 卫 一 一 积分 时 间 常数 ， 罗 一 微分 时 间 常 数 。 

简单 说 来 ，PID 控制 器 各 校正 环节 的 作用 如 下 : 

(1) 比例 环节 : 成 比例 地 反映 控制 系统 的 偏差 信号 emor(D) ， 仿 差 一 旦 产生 ， 控 制 器 立即 
产生 控制 作用 ， 以 减 小 信 差 。 ， 

(2) 积分 环节 ， 主要 用 于 消除 静 差 ， 提 高 系统 的 无 差 度 。 积 分 作用 的 强 弱 取决 于 积分 时 
间 常 数 石 ， 刀 越 大 ， 积 分 作用 越 弱 ， 反 之 则 越 强 。 

《3) 微分 环节 : 反映 偏差 信号 的 变化 趋势 《变化 速率 )， 并 能 在 偏差 信号 变 得 太 大 之 前 ， 
在 系统 中 引入 一 个 有 效 的 早期 修正 信号 ， 从 而 加 快 系统 的 动作 速度 ， 减 少 调节 时 间 。 

















1.2 ”连续 系统 的 模拟 PID 仿真 


1.2.1 基本 的 PID 控制 


以 二 阶 线性 传递 函数 为 被 
时 了 肥大 =60， 大 =1， 司 = 了 3 刷 
用 ODE45 和 迭代 方法 ， 仿 真 时 间 为 10s 
仿真 方 
在 Simulink 下 进行 仿真 ，PID 控制 由 Simulink 下 的 工具 条 提供 


仿真 程序 ，chap1_lmdl， 如 疼 1-2 所 示 


寺 象 ， 进 行 模 氢 | PID 拉 制 ， 在 人情 导 发 生 器 中 选择 正弦 信号 ， 仿 真 


队 入 指令 为 rintf)= 4sin(2rr) ， 其 中 4A=10, 上 =020Hz,， 采 





















入 1-2 连 姑 系统 PID 的 Smulink 仿真 程 这 


[图 1-3 所 本 





在 PID 控制 并 采用 Simujink 封装 的 形式 ， 其 内 癌 














S 
PreaEY 
个 人 -一 一 

Denvawe 


图 1.3 模拟 BID 控制 紧 


连 线 系 统 的 模拟 PLD 控制 正 兹 响应 结果 如 图 14 所 示 





峡 1.4， 连 钼 系统 的 模拟 PID 控制 正 交 明 i 


仿真 方法 二 
在 仿真 一 的 基础 上 ， 将 仿真 结果 输出 到 工作 空间 中 


， 利 几 MW 通 数 作 图 ， 仿 真 结果 刀 
图 1-5 所 示 。 














4 5 
timets) 
图 1-5 PID 控制 正弦 响应 
仿真 程序 : chap1l_2.mdl。 


程序 中 同时 采用 了 传递 函数 的 另 一 种 表达 方式 , 即 状态 方程 的 形式 ， 中 | 
































0 _ 
e-| 吕 |， C=[f 0]，D=0， 如 图 1-6 所 示 。 








人 








To Wotspace1 


























































































































| -全 
到 2 二 | 
F Term wx 
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Sine wave PiID Eontelter 
Sum 
= AxrBu 
ys cxrpu 
yo 
Pt 
ToWGWSRICe2 
t 
Ce Te Wetspace 


图 1-6 连续 系统 PID 的 Simulink 仿真 程序 
对 函 数 作 网 程序， chapl_2plotm. 


close al17 


plot (Erin，K' LOuUE，K 1)I 
X]labell'binels) 


Yabeli' zy 7 


仿真 方 ; 
S 函数 是 Simulink 一 项 重要 的 功能 ， 采 用 本数 可 实现 在 Simulink 下 复杂 所 
被 控 对 银 的 编程 在 仿真 上 ， 利 放 $ 函数 实现 








器 和 复杂 


的 表达 、 控 制 器 的 设计 及 仿 页 结 











数 , 即 mdlinitializeSizcs 琴 孝 





在 S 榴 数 中 , 采用 初始 化 .做 分 了 画 妇 和 末 mdlDerivatives 
函数 和 mdlOutputs 冰 数 .在 初始 化 让 除 出 ，3 个 输入 ，3 个 输入 立 
到了 P.1、D 三 项 的 输入 ,S 函数 梳 入 在 Simalink 各 厅 中。 条 综 初 始 状 态 为 ; MO=0RO=0 





用 sizes 缚 怕 ， 选 择 2 个 





仿真 站 果 如 图 1-7 所 可 








#，chap1_3.mdl 基于 了 两 数 的 





人 - 记 一 盖 
可 -- | 
| 一 > TY | 
二 二 | |] we 上 
| 
圳 -一 2 侣 六 + 
-一 一 一 人 [ 
人 |m 4 一 人 < 
人 assal secy 
胃 1.3 于 下 二 数 的 Simulink 什 真 


S 冰 数 控制 器 程 尿 chap1_3s.m 


[syYs,X0,Str,ts]=mdlInitializeSizeSy 
#%OutDputs 
Case 3， 
SY8=mdlOutDpuLsS tx,a) 7 
&%Unhanqled fags 
case {2，4，9 } 
SYS = E 
对 Unexpectedq flags 
otherwise 
erzror(['Unhandled flag = ,num2str(flag)])7 


endQ 


mc TnitaliZzeSizeSs 
funetion [sys,x0,str,tsj=mdlInitializeSizes 


Sizes = Simsjizes7 


sizes.NumcontStates = 07 
sizes.NumDiscStates = 0; 
Sizes,NurmOurpurSs = 1 
sizes.NumInPU 上 S = 3? 





sizes.DirFeedthrough = 


Sizes.NumSathD1epimeS = 


sys=simsizes(sizes)7 
x0=[]7 

Stx=[]7 

ts=[]? 


function sys=mdlOutputs (Fr,x,ua) 
erTTOI=UII) 
Qerror=ut211 


errori=u(3)7 


kp=60; 
Ki=17 
ka=317 


uE=kpwertDL+KdxGerrOF+KixerrOLiY 


SYS 11)} =ut 
S 函数 被 控 对 象 程序 : chap1_3plantm。 


%8-function for conLinuous state eqguaticn 


function [sys,x0,str,ts]=s_ftunctiontt ,xuylag) 


Switch flag， 
&%Inicializacion 
case 0， 
Tsys,x0,str,cs]=malInitializeSi<ces: 
case 1， 
ays=malDerivarives (ft ,xl 
8Outputs 
case 3， 
sys-maloutPuts tt ;xiu1， 
sUnhandled flags 
case {2，4，9 
sys = 1 
s#Unexpected flags 
otherwise 
error1T'Unhandiea flag = ,num2strtElag)1)7 


enq 


smalInicialize8izes 

function [sys,x0,stz,ts]=-md2InitializeSi2zes 
Sizes = SimsizeSs7 

sizes.NumContStates = 27 
sizes,NumpiscSrates = 01 

sizeg.Numoutputs = 1 

sizes.NurmInputs = 1; 
sizes,DirFeeathrough = 0; 


sizegs .NumSampleTimes = 0 


sys=simsizes(sizes)y 
x0=f0,0j7 
Str=[] 上 


ts=[]7 


functipn SYS=malDezivatives {t,Xru) 





6， 





1.22 线性 时 变 系 统 的 PID 捧 


仿真 实例 

设 被 控制 对 象 为 ， 
天 
G15) = 一 一 


一 二 
答 入 指令 信号 为 0.5siof2rt)，/=20+10sinf6rr) ， 克 =400+300sin(2rxr) 。 采 用 PD 控制 
算 沪 进行 工 
仿真 方法 一 
用 Simulink 仿真 ， 通 过 Simulink 模 快 灾 天 不 研 定 对 条 的 表示 ， 取 大 =10， 片 =0- 
A =10。 仿 真 结 果 如 余 1-9 所 也 











图 1.9 正 喜 啊 麻 


仿真 程序 ，chapl_4.mdl， 如 图 1-10 和 图 1-11 所 可 














时 1-10 Simulink 主 秆 放 














乡 1-11 Simalink 子 程序 


仿真 方法 二 

采用 S 函数 的 方 
在 5 函数 中 ， 采 用 初 
函数 和 mdlOutputs 函数 。 在 初始 化 中 采用 sizes 
现 了 P.1.D 三 项 的 输入 . 3 函数 内 入 在 Simulink 
取 夺 =10， 与 =2， =1， 仿 真 结 有 果 如 如 1-12 所 示 ， 


进行 仿真 。 不 哺 定 对 象 的 表示 、 控 负 癸 的 实现 及 输出 由 函数 完成 。 
、 福 分 函数 和 输出 冰 数 ， 即 mdlinitializeSizes 函数 、mdIDerivatives 
3 个 输入 ，3 个 输入 实 
为 : xD)=0i0)=0， 

















疼 1-12 正弦 虽 应 


仿真 程序 ，chap1_5.mdl， 如 图 1-13 所 未 
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图 1-13 Simulink 子 程序 


S 函数 子 程序 : chapl_5s.m。 


function [sys,x0,str,Es] =- spacemodel(t,xra,flagl) 


swirch Elag， 
Case 0， 
fsys,x0,str,ts] =mdlInitialize8izes; 
Case 1， 
SyS=mdlDerivativestt, xu) 7 
Case 3， 
SYS=mdlOutputs tt, Xu)7 
Case {2,4,91} 
SYS=【] 了 
Otherwise 
error(['Unhandled flag = ,nurm2stz{(flag)])7 


en 


function [sys,x0,StT,tS]=mdlInitializeSizes 
8izes = Simsizesy 

sizes.NumcontStateg = 2; 
sizes.NumDiscStates = 0; 

sizes.NumOutpPutS = 工 

sizes.Numinputs = 31 
Sizes.DirFeedthrouogh = 0: 
Sizes.NumSampleTimes = 1 % ar least one sample time is needed 
SYS = SimsizeSftsizeSs) 1 

x0 = [950]: 

Srr = [> 

ts = [0 0j7 





function sys=mqlDerivarjvesIL,x,u)  %Tire-varying model 
KP=10) 
Ki-21 
kq=1; 


ut=kpxut1)+kisut2)+kdrul3)7 


J=20+10*sinf6*PirEh 1 


K=40D+300*Ssjnf2xrpIixt)》 7 


SYS YI1)=X{2)7 
sysxd2)=-Jxx(2]+<Kxuat: 


function sys=mqlOatPutstt,x,ul 


SYSst])=xt1)7 
通过 本 实例 的 仿 贞 ， 可 见 采 用 S 丽 数 ， 很 容易 地 表 泵 复杂 的 被 控 对 象 帮 控制 算法 ， 特 别 
适合 于 复杂 系统 的 仿真 。 
{1.3 数字 PID 控制 


计算 机 控制 是 一 种 采样 控制 , 它 只 能 根据 采样 时 刻 的 信 差 值 计算 控制 量 。 因此 , 连续 PID 
控制 算法 不 能 直接 使 用 ， 需 要 采用 离散 化 方法 。 在 计算 机 PID 控制 中 ， 使 用 的 是 数字 PID 控 
制 器 。 


1.3.1 位 置式 PID 控制 算法 


按 模 拟 PID 控制 算法 ， 以 一 系列 的 采样 时 刻 点 好 代表 连续 时间 ， 以 矩形 法 数值 积分 近 
似 代 赫 积 分 ， 以 “ 阶 后 癌 差分 近似 代 蔡 微 分 ， 即 : 


卫 关 了 ( 伏 三 01.2…7) 








jeror(odt <T 立 enor( 77)= 7 室 eror 万 (1.4) 
] 问 
derror( 执 erTOTCKT ) 一 error(( 人 一 DZ) 一 error( 大 ) 一 etTOI( 天 一 扩 
gd 了 了 了 
可 得 离散 PID 表达 式 : 
天 
(大 )》 一 各 (error(K) + 工 >error( 有 十 了 emortk) 一 error( 上 一 J)) 

也 二 了 (15) 


error(Ky 一 error( 大 一 卫 


所 
= error(K) 十 大 error( PT 十 如 却 


了 


*， 10。 


开 
式 中 ， 五 = 六 ， 如 =8TD， 了 为 采样 周期 ， 大 为 采样 序号 ， 大 =12……ermror( 一 D 和 error(i) 分 
1 


别 为 第 (kf -1 和 第 大 时 刻 所 得 的 仿 美 信号 。 
位 置式 PLD 控制 系统 如 岁 1-14 所 示 。 




















yout( 
| 被 控 对 银 一 














大 
| = 上 pe | Fen 











根据 位 置式 PID 控制 算法 得 到 其 程序 框图 如 岁 1-15 
所 示 。 

在 仿真 过 程 中 ， 可 根据 实际 情况 ， 对 控制 此 的 输出 
进行 限 幅 : [-10，+10]。 


1.3.2 连续 系统 的 数字 PID 控制 仿真 


本 方法 可 实现 DA 及 A/D 的 功能 ， 符 合 数字 实时 控 
制 的 真实 情况 ， 计 算 机 及 DSP 的 实时 PID 控制 都 属于 这 
种 情况 。 

仿真 方法 一 

采用 MATLAB 语句 形式 进行 仿真 。 被 控 村 象 为 一 个 
电机 模型 传递 函数 : 


G() = 一 了 一 一 
人 JJ82 + Bs 


式 中 ， 了 = 0.0067,83 = 0.10 。 





图 1-14 位 置式 PID 控制 系统 
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计算 偏差 入 








计算 
控制 器 输出 








移 数 更 新 上 





运 区 
图 1]-15 位 置式 PID 控制 算法 程序 框图 





采用 M 库 数 的 形式 ， 利 用 ODE45 的 方法 求解 连续 对 象 方程 ， 输 入 指令 信和 号 为 
rin(ij=0.50sin(2xb) ， 采 用 PID 控制 方法 设计 控制 器 ， 其 中 态 = 20.0, 后 =0.50 。PID 正弦 跟 


踪 结 果 如 图 1-46 所 示 。 














5 1 
25 timele) 


图 1-16 BID 正弦 跟 帕 
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控制 主 程序 ，chap1_6.m。 
sDiscrete PID control for continuous plant 
Clear Ball7 


Close all7 


上 s=0.001; %Sampling time 
Xk=zeros (2,1)7 

e_1=0; 

U_1=01 


for k=1:1:2000 
上 time {k) = Kx*tS7 





in(K) =0.50wSjn(1xZxDpiwkxfC) 7 


Parasu_ 名 DA 

tSPan=[0 tsS] 7 

Ett,， xxj=odqe45('chapl_6f' ,上 Span,Xxk,[] ,paral 
xk = xx{fLength(xxj，:); 8 发 /D 

Yout (K) =xk{(1) 3 


el(k)=rin(k)-yout(k)7 
aetk)=(efk)-e_1)/ts7 


uki=20.0*etk)+0.50*defk) 
gcControl limit 
if ulfk)>10.0 


utk)j=10.0; 
enQ 
1iE utk)<-~10.0 
utk)=-10.0; 
end 
1=utk) 
e_1=efk)7 
end 
EiguxelI1)7 


BPlok (time,rin, rtime,yout，b')i 

xlabelt'time(s)') ,yl1abelf zinyout ) 

figureft2)7 

plot (time,zin-yeut， TD) 7 

xltabell'cimels)'),ylabel('error ) 
12。 





连续 对 象 子 程序 ，chap1_6fm。 
function dy = PlantModel(t,y,Elag,Pparaa) 
u=para 


J=0.00677B=0.1: 


Gy=zeros(2,1) > 
Gytl) =Yf(2)7 
Gyt2) = -(B/AJ)r*y(2) + (174I)xur 


仿真 方法 二 

采用 Simulink 进行 仿真 。 被 控 对 象 为 三 阶 传 递 函 数 ， 采 用 Simulink 模块 与 W 函数 相 结 
合 的 形式 ， 利 用 ODE45 的 方法 求解 连续 对 象 方程 ， 主 程序 由 Simulink 模块 实现 ， 控 制 器 由 
Mf 函数 实现 。 输 入 指令 信号 为 一 个 采样 周期 Ims 的 正弦 信号 。 采 用 PID 方法 设计 控制 器 ， 其 
中 二 =15, 帮 =2.0, =0.05。 误 差 的 初始 化 是 通过 时 钟 功 能 实现 的 ， 从 而 在 M 函数 中 实现 了 
误差 的 积分 和 微分。 

控制 主 程序 ， chap1_7.mdl， 如 图 1-17 所 示 。 
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图 1-17 Simulink 仿真 程序 图 
控制 器 子 程序 :chapl_7fm。 


function [ul=piqsimEtftualt,a2) 


Per8istent bitamat errori ezrror- 1 


it u1==0 
ETOri=0 
error_1=0 


end 
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仿真 方法 三 

利用 S 函数 
函数 和 输出 函 党 
中 采用 sizes 寻 构 ， 选择 一 个 西 个 输入 ， 其 中 一 个 输 大 为 误差 信 和 号 ， 另 一 个 输入 为 误差 
信号 上 一 时 刻 的 值 - 8 函数 扰 入 在 Simwulink 程序 中 ， 采 祥 时 间 为 lmms， 

芒 真 程序 的 Simulink 主 程序 ，chapL_8.mdl， 因 1-19 匠 末 






















巍 上 与 基于 了 霄 数 的 Simulink 仿真 在 译 用 


S 函数 仿真 程序 ，chatpl_S8s.m 


*14* 


sys = mdlUpdatestx,u); 
case 3 8 computation of control signal 
杀 sys = mdloutputs(t ,xia,kp,ki,ka,MTabl; 
sys-=mdlOutpucs (xsu)y 


case {1，4，9} % unused flag values 


SYS = []) 
otherwise Serror hanaling 
error1['Unhandled flag = ，,num2strtflag)])7 
endy 


争 =， 





多 when flag=<0，Perftorm SyStem initiali2zatrion 


杀 =， 





function [sys,Xx0,strv,ts] = IdlInitializeSizes 

Sizes = Simsizes: 多 Teaad Gefanlt conrrol varIahbl1eg 
sizes.NumcontStates = 0; & no continuous States 

sizes.NumDiscStates = 3; g% 3 states and assume Lhey are the P/I/7D CompomrenrS 
sizes.NumOutputs = 1 多 2 output variables: Control ut) and State XI(3) 
sizes.Numinputs = 2; % 4 input signals 

sizes-DitrFeedthrougn = 17;& input reflectea Qirectly in output 


sizes.NumsampleTimes =- 1;8 single sampling perioq 


sys =- simsizes(sizes); 当 

x0 = [0; 0 0]7 8 zero initial states 
Str = []: 

rs = [10]; s sampling period 





g% when flag=2，upaates the qiscrete StateSs 





条 =: 
functicn sys = mdlUpdates (xy,u) 


T=0.0017 


SYS=[ ftI) 
X(2)+UL)*T7 
tuatl)-ut2))7T]7 





多 = 


8 when flag=3，computates the outpat signals 





多 =: 
function sys = mal0outputs(tt,Xx,aykp,kiykq,MTab) 


kp=1.57 
=2 07 
kkd=.057 


。15 。 





图 120 PID 正 线 哇 足 
1.3.3 ”离散 系统 的 数字 PID 控制 仿 南 


仿真 实例 
没 被 控制 对 象 为 : 





采样 时 间 为 1ms， 采 用 Z 变 换 进 行 离散 化 ， 经 过 Z 变 换 后 的 离散 化 对 象 为 : 
yout( 大 )= -den(2)yout( 丰 一 中 一 den(3)yput( 大 一世 一 den(4)yout(K 一 习 十 
mumf(2)juf 大 一 站 +mum(3w(K 一 臣 +num(4ju[ 大 一 习 
仿真 方法 一 
针对 启 向 系统 的 阶 牙 信号 3 和 方 波 信 导 的 位 置 响应 ， 设 计 离散 PID 撑 制 器 。 其 
中 ,8 为 信号 选择 变 和 最，S = 1 时 为 阶 跃 跟 际 ，S=2 时 为 方 波 跟 踪 ，3=3 时 为 正弦 跟踪 ，PID 
航 跃 跟踪 结果 如 锋 1-21 一 图 1-23 所 示 






1.5 


rin.yout 


05 


0 5 time(s) 


图 121 PD 阶 跃 踊 吕 1S=1 


“16* 











0 05 timefs) 1 


图 1-22 PID 方 波 跟 踪 〈S=2) 











0.5 


timetks》 1 15 


图 1-23 PIDP 正弦 跟 踪 (3=3) 


仿真 程序 ，chap1_9.m。 
#PID Concroller 
Clear al17 


Cloge al11; 


ts=0.0017 
sygs=tf(5.235e005,[1,87-35,1.047e004,D]) 7 
Gasys=c2dtsys,ts， zi 
[num,den]=tfdatatdsys，vV') 


u_1=0.0;u_2=0.0;u_3-0.07 
Y_1=0.0jy_2=0.0;y_3=0.0; 
x= [0.0,03 





:1500 
七 于 下 (天 ) = 长 * 七 久 了 
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=0.0017kda=0.001: 


SSteP Signal 





kP=0.50;:Kkj=0.0017kd=0.0013; 





Yintk)=szgnteinI2x2xpixkxtS)) $%Square Wave 5igmal 
elseit S==3 
kpP=1.57Ki=1.0:kq=0.0t: 8Sinre Signal 
FintfKk)=0,5*Sinf2*2*DITYyKr 开 号) 7 
ena 
uik)=kPp*xf1)+KQxxt2)+KiX(3) 7 生 BID ContrO11er 


#Restricting the output of controller 
1 tkj>=10 
utk)=107 
end 
TiFE utkj<=-10 
utk)=-107 
ena 


要 Linear modqe1 





yout (kj=-den(2)*y_ 1-den(3)xy 2-dent4)xry_3+num(2)*u 1L+num(3)wu_2+nurm(4) wu 37 


errortk)=rinfk)-yout(K) 7 


%Recurn Of ParameterS 
u_3=u_2:D_2=u_1;u_3=utk) 


Y_3=y_2;Y_2=Y_1;y_1=yout{k) = 


xf(1)=errorik) 7 多 CalculaLing 已 
xf(2)= (error(x)-error_1) /ts 8%Calculating D 


xft3)=xf(3)+errOT(K) xS7 多 CalLculating 工 


error_T=error [K] 1 


eng 

figuretI1hy 

plot (fime,zin，'k'ytime youtk' 
xlabel('timets) ) ylabel(' rinyout ) 
仿真 方法 二 


针对 离散 系统 的 一 角 波 、 锯 齿 波 和 随机 信号 位 置 响应 ， 设 计 离散 PID 控制 器 ， 各 信号 的 
跟踪 结果 如 图 1-24 一 网 1-26 所 示 ， 其 中 $ 代表 输入 指令 信号 的 类 型 通过 取 余 指令 mod 实 
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现 一 有 角 波 和 锯齿 波 ， 当 S=1 时 为 一 角 波 ，S$=2 时 为 饥 齿 波 ，S=3 时 为 随机 信号 。 在 仿真 过 程 
中 ， 如 果 P=1， 则 通过 pause 命令 实现 动态 演 杰 仿 贞 。 在 确 机 们 号 跟踪 路， 对 能 机 信号 的 变 
化 速率 进行 了 限制 。 


0.6 -一 - -一 


-0.8 -- -- - 四 
0 0.5 15 2 25 3 
timetfs) 


图 1-24 PID 一 用 波 跟踪 (3S=1) 


-02 - _ 
0 0.5 了 1.5 2 2.5 3 
timets) 


图 1-25 PID 角 具 波 跟 踪 〈S=2) 





D 0.5 1 2 2.5 3 


1 号 
timets) 


疯 126 PID 随机 信号 申 嘱 〔S=3) 


.19. 


仿真 程序 : chap1_10.m。 
gPID Controllcr 
Clear al17 


close all; 


ts=0.001: 
SYS=tt(5.235e005, [1,87.35,1.047e004.0])7 
Qsys=c2d (sys,ks，' 二 ) 7 


[num,qen]=tfdatatGQsys，V' 1 


u_I=0.0:u_2=0.0iu_3=0.0) 
_1=rangi 


Yy_1=0;Yy_2=077_3=02 


xX=[9,0.0] 7 


error_1=07 


for Kk=1:1:3000 


上 ime(k)=Kxts7 
kBp=1.07:Ki=2.0;1kG=DO.01: 


S=11 
if S==1  &Triangle Signal 
if moa(time(k)，2)<1 
rintk)=moqttime(k) 1)1 
else 
zinmtk)=1-moaQ(ttime(Kk) 1) 1 
Enmd 
rintk)=rinfk)-0.57 
ena 
iE S-=2 Sawtooth Signal 
rintk)=modttimetk) 1.0)1 
end 
if S==3 8Random Signal 
Tin(k)=randi 
wr(k) =trintk)-r 1)/tsi 8%Max speeq is 5.0 
while abs(tvrtk))>=5.0 
rintk)=randi 


VE (KJ)=abst(trintk)-c_L)Vts) 


-20。 





end 


engq 


(KJ) =KPy*X(1) +KGYX(2)》+XITnw 


(3 7 


&%TFID Controller 


#Rescricting Lhe Dutput cf comntrollez 


if utkl>=10 


utk)=107 

enq 

if utkl<=-10 
utklj=-10: 

eng 


向 Lineatr model 


yout (kj=-aent2)xy_1-den13)*y_2-aent4)yy_3+num(2)*u_L+numt(3)*u 2+num(4)su_37 


errOLTIK) =Tin(Kk) -YOUE(K) 7 


C_L=rintk) 


D_3=u_21uU_2=u 17uU_L=u(KT 





Y_3=y-2;17-_2=Y_1;Y7- 


冬 (1)=error [K) 7 


=Yout (kg) ; 


生 局 


X{12)=1error[(K) -erEor 1) /SI 


X{13)=xf3)+errortk)*tsy 


区 工 (K) =X(3) 


ezzor_1=errortk) 7 


D=D0: 


alculating 了 
#Caleulacing D 


针 Calculating 工 


E D==1 8&%Dynamic Sirmularion Display 


Blet (tirney in， Dime youL， 


Pause(0.000000000000D0000) 


em 


enda 


PlLok (time,riny rtimeyout pb) 


xl1abe1t'timets) ' )ylabell'rinyyouc 1 


上 述 PID 控制 算法 的 缺点 是 ， 由 于 采用 全 量 输 出 ， 所 以 竹 次 箱 出 均 与 过 去 的 状态 有 关 ， 
计算 时 要 对 error(k) 旦 进行 累加 ， 计 算 机 输出 控制 基 改 扣 对 应 的 是 执行 机 构 的 实际 位 置 偏差 


如 果 位 置 传感器 出 坝 故 障 ， KR) 可 


能 会 


出 现 大 幅度 变化 。w(k) 的 大 幅度 变化 会 引起 执行 机 构 


位 置 的 大 幅度 变化 ， 这 种 情况 在 生产 中 是 不 允许 的 ， 在 某 些 重要 场合 还 可 能 造成 重大 事故 。 
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为 醒 免 这 种 情 可 采用 增 量 式 PID 控制 算法 
仿真 方法 三 
采用 Simulink 实现 高 履 PLD 控 


在 该 外 面 中 可 设 定 PLD 的 三 个 条 数 样 时 间 及 控制 办 








必 PID 控制 的 封装 界面 如 用 1-27 记 示 
上 下 闭 . 仿 真 结果 如 闭 1-28 所 示 











图 1-27 珊 区 FID 控 





仿真 程 床 ，chapl_11.mdt， 如 图 1-29 和 疼 1-30 所 示 、 其 中 PID 控制 的 比例 ， 濑 分 和 积分 
项 分 别 由 Simulink 异 块 实现 
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加 1.29 主 散 PID 控制 的 Sinmlink 主宰 厅 
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1-30 离散 PID 控制 的 Simulink 控制 器 程序 





1.3.4 增 量 式 PID 控制 算法 及 仿真 


当 执行 机 构 需 要 的 是 控制 量 的 增 量 〈 例 如 驱动 步 进 电机 ) 时 ， 应 采用 增 基 式 PID 控制 。 
根据 递 推 原理 可 得 ; 
u(-D= 大 (errorK 一 DD+ 大 各 mor(CD+(errork-D 一 emork 一 2 (1.6) 
问 


增 量 式 PID 控制 算法 : 
Aa( 品 =w 昌 一 ME 
Ai( 间 = 后 (emror( 虽 -emror(k 一 切 + 大 error( 和 +a(error 旭 一 2error~D+emror-27) 《17》 


根据 增 量 式 PID 控制 算法 ， 设 计 了 仿真 程序 。 设 被 控制 对 象 如 下 ， 
cG@= 1 +505 

PID 控制 参数 为 :如 = 8,Ki =0.10,ku =10。 

仿真 程序 ，chapl_12.m。 

$ITncrement PID Concrollez 


clear all7 


close all7 


ts=0.-0017 
SYSs=tft400, [1,.50,0])7 
QsYs=c2G4SYS ES ET ) 






[num,den] =tfdatatdsys，v') 1 


u_l=0.0;u_2=0.0;u_3=0.01 
Y_-L=07Yy_2=07Y-3=07 


xX=[0,0,01 7 
error_1=07 


error_ 2=017 
for k=1:1:1000 
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七 ime fk)=kK*tSs7 


Fintk)=1.07 
kp=87 
Ki=0.10; 
kgq=10y 


Qu (K) =KPyX(1L)+XG*XIZI+KI+X(3) 7 
UK)=u_ 1+autk)7> 


革 EutK)>=10 


fk)=10: 
en 
E ukj<=-10 
UK = 一 工 台 7 
engq 


yout (kj=-dqent2jx*y_l1-den(3)*y_2+num(2)xu_ 1L+nunmf3)*u 27 


ercor=Tinftk)-youk (了 ) 7 
_25u_2-u lzu_1=utk)， 





LU 


YY_3=y_27y7_2=y_E)Y_1=Yout (k) 7 


Xt1)=erzror-error_ 1: 8Caleculaking 
X{2)=error-2xerror 1+eTIOLF_21 8CalculLating D 
区 13) = 人 FTOIT 刍 Calculating 工 
error_2=error 117 








SIIOLT_1L=errOor7 
emQ 
了 lot (time,Tin， Ptcime youL， 工 ) 


xlabelt'timels)' ) ;ylabpelf rin,yout ) 7 


增 量 式 PID 阶 路 跟踪 结果 如 图 1-31 所 示 。 





08 1 








0 02 04 


timets) 06 


岁 1-31 增 量 式 PID 和 阶 跃 跟踪 
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由 于 控制 算法 中 不 需要 累加 。 控 制 增 基 Au(k) 仅 与 最 近 大 次 的 采样 有 关 ， 所 以 误 动作 时 
影响 小 ， 而 闪 较 容易 通过 加 权 处 理 获得 毕 较 好 的 控制 效果 。 

在 计算 机 控制 系统 中 ，PID 控制 是 通过 计算 机 程序 实 坝 的 ， 因 此 它 的 灵活 性 很 大 。 一 些 
原来 在 模拟 PID 控制 器 中 无 法 实 坝 的 问题 ， 在 引入 计算 机 以 后 ， 就 可 以 得 到 解决 ， 于 是 产生 
了 -系列 的 改进 算法 ， 形 成 非 标准 的 控制 算法 ， 以 改善 系统 品质 ， 满 足 不 同 控制 系统 的 需要 。 


1.3.5 ”积分 分 离 PID 控制 算法 及 仿真 














在 普通 PID 控制 中 ， 引 入 积分 环节 的 目的 主要 是 为 了 消除 静养 ， 提 高 控制 精度 。 但 企 过 
程 的 启动 、 结 束 或 大 帼 度 增 减 设 定时 ， 短 时 间 内 系统 输出 有 很 大 的 偏差 ， 会 造成 FID 运算 的 
积分 积累 ， 致 使 控制 量 超过 执行 机 构 可 能 允许 的 最 大 动作 范围 对 应 的 极限 控制 量 ， 引 起 系统 
较 大 的 超 调 ， 甚 至 引起 系统 较 大 的 振荡 ， 这 在 生产 中 是 绝对 不 允许 的 。 

积分 分 离 控制 基本 思路 是 ， 当 被 控 量 与 设 定 值 偏差 较 大 时 ， 取 消 积 分 作用 ， 以 免 由 于 积 
分 作用 使 系统 稳定 性 降低 ， 超 调 量 增 大 ， 当 被 控 量 接近 给 定 值 时 ， 引 入 积分 控制 ， 以 便 消 除 
静 差 ， 提 高 控制 精度 。 其 具体 实现 步骤 如 下 : 

51) 根据 实际 情况 ， 人 为 设 定 阐 值 e>0 

(2) 当 |error(ej|>e 时 ， 采 用 PD 控制 ， 可 避免 产 生 过 大 的 超 调 ， 又 使 系统 有 较 快 的 响应 ; 

(3) 当 |error(tj<e 时 ， 采 用 PID 控制 ， 以 保证 系统 的 控制 精度 。 

积分 分 离 控制 算法 可 表示 为 : 

MK) = 大 eTTOF(K) 十 甩 石 立 erorCD7+ 和 (error() 一 error( 天 一 DY 了 《1.8) 


0 


式 中 ， 了 为 采样 时 间 ， 月 项 为 积分 项 的 开关 系数 





































6- 1 |error(x se ao9) 
0 eror(t>e 
根据 积分 分 离 式 PID 控制 算法 得 到 其 程序 世 本 
框图 如 图 1-32 所 泵 。 人 
仿真 实例 
设 被 控 对 象 为 一 个 延迟 对 象 : 采信 站 内 用 Yod 的 
-ao 
_ 计 让 入住 
GCC = 38 mor ( 





采样 时 间 为 20s, 延迟 时 间 为 4 个 采样 时 间 ， 
即 80s， 被 擦 对 象 离散 化 为 : 
y( 间 =-den()yK-D+nunaC2OaE 一 5 






























PID 控制 PD 控 制 
行 仿真 。 取 M =1， 采 用 积 站 
分 分 亢 式 PID 控制 器 进行 阶 跃 响应 ， 对 积分 分 














离 式 PID 控制 算法 进行 改进 ， 采 几 分 段 积分 分 才 数 更 新 
离 方 式 , 即 根据 误差 绝对 值 的 不 合 , 采用 不 同 的 
积分 强度 。 仿 真 中 指令 信号 为 rn(t)= 40 ， 控 制 
器 输出 限制 在 二 110,110] ， 其 阶 跃 式 跟踪 结果 如 图 1-32 积分 分 离 式 PID 控制 算法 程序 框图 
25 。 











返 








图 1-33 所 示 。 取 M =2 ， 采 用 普通 PID 控制 ， 其 阶 跃 式 跟踪 结果 如 图 1-34 所 示 。 


rin,yout 

















9 - 人 
0 500 1000 1500 2000 2500 3000 3500 4000 
timets)》 
图 1-33 ”积分 分 离 式 PID 阶 姥 跟 踪 〈M=1) 
咱 . | 
0 500 1000 1500 2000 2500 3000 3500 4000 


timets) 
图 1-34 采用 普通 PID 阶 唉 跟踪 (MW=2) 
仿真 程序 : chap1_13.m。 
8InkEegrakion Separation PID Controller 
clear al]17 


close al17 


ts=20 

Delay PLant 
sys=tft[1],[60,1]，inputaelay' ,80)1 
dsys=c2Q(sysrts，，zoh') 7 


[num,den]=tfeatalqsys，'V' 1) 7 


1I=0;u_2=0;u_3=07u_4=0:u_5=07 


“26， 





y_1=0iy7_2=0:y_3=01 
error_1=Dierror_2=01 
ei=07 

for kx=1:1:200 


二 ime (KK) = 长 xtS 7 


8Delay Plant 
yout (k)=-~denl2)8y_1+Puamf2)+a_ > 


第 TI_ Separation 
Tin(XK)=407 
ezror (K) =TrintKk)-Yycout{K) 7 


ei=eI+erreor(k)*LS 


M=27 
if M== 8Using integrarion separacion 
E absterrortk)]>=30&absterror (kl)<=40 
Deta=0.37 
elseif absferror(k))>=-20&abs(crroz fkK))<-30 
Deta=0.55 
elseif abs(error(k))>=105abs(errorfk))<=-20 
beta=0.917 
else 
beta=1.03 
end 
elseif M==2 
Peta-1.06) 8Not using jintegration separation 


em 


kP=0.807 
ki=0.005: 
kd=3 .07 


UK) =kpxerrorik)+kdx ferror (K) -erTor_1) /LS+hbetarxkixey 


ifE ukK)>=110 务 Restricting the OutPut Of conbroller 
UfK)=1T107 
ena 


了 IE ukj<=-IED 


.27 








由 仿真 结果 可 以 看 出 ， 







控 抽 效果 有 很 大 的 改善 。 值 得 注意 的 是 ， 为 
保证 引入 积分 作用 后 系统 的 秘 % 大 积分 作用 时 比例 系数 人 可 进行 相应 变化 . 此 
外 ， 甩 值 应 根据 县 体 对 象 及 要 求 而 定 ， 若 厅 过 大 ， 则 达 不 到 积分 分 离 的 目的 ;, 若 有 过 小 ， 则 
会 导致 无 法 进入 积分 区 。 如 采 只 进行 PD 控制 ， 会 使 控制 出 现 余 莽 

仿真 方法 二 

采用 Simulink 仿真 , 通过 Simulink 模块 实现 积分 分 离 PLD 控制 算法 , 仿真 结果 如 图 1-35 





所 未 





图 1.35 阶 就 响 记 稍 果 


仿真 程序 的 初始 化 程序 ，chap1_14fm 





qsys=c2ddsys,ts， 2zoh' 7 


[num, derj=btQata(dsys，，vV 1)7 


kKP=1.807 
ki=0.957 
kaq=0.207 


Simulink 主 程序 ，chapl_14.mdl， 如 图 1-36 所 示 。 
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图 1-36 Simulink 仿真 程序 


1.3.6” 抗 积分 饱和 PID 控制 算法 及 仿真 


1， 积 分 饱和 现象 


所 谓 积 分 饱和 现象 呈 指 若 系统 存在 一 个 方向 的 偏差， 
PID 控制 器 的 输出 由 于 积分 作用 的 不 断 累 加 而 加 大 ， 从 而 
导致 执行 机 构 达到 根 限 位 置 X。 《例如 阅 门 开 度 达 到 最 
大 )， 如 图 137 所 示 ， 涛 控制 器 输出 w 和 继续 增 大 ， 网 站 
开 度 不 可 能 再 增 大 ， 此 时 就 称 计算 机 输出 控制 量 超出 了 正 
常 运行 范围 面 进入 了 饱和 区 。- 旦 系统 出 现 反 向 偏 壮 ,MA 
逐渐 从 侈 和 区 退出 。 进 入 饱和 区 愈 深 则 退出 饱和 区 所 需 时 
问 意 长 。 在 这 段 时 间 内 ， 热 行 机 构 仍 停留 在 极限 位 置 而 不 
能 随 仿 差 反 向 立即 做 出 相应 的 改变 ， 这 时 系统 就 像 撩 去 控 。 图 1.37 执行 机 构 鸳 和 特性 
制 一 样 ， 造 成 控制 性 能 恶化 。 这 种 现象 称 为 积分 侈 和 现象 
或 积分 失控 现象 


2， 抗 积分 饱和 算法 


作为 防止 积分 饱和 的 方法 之 -- 就 是 抗 积分 亿 和 法 。 该 方法 的 思路 是 ， 在 计算 w 训 时 ， 首 
209. 























先 判断 上 一 时 刻 的 控制 量 x(K -1 是否 已 超出 限制 范围 。 若 zk-D > ks， 则 只 累加 负 偏差 ; 
若 kKk-D<amsx， 则 只 虽 加 正 偏差 。 这 种 算法 可 以 避免 控制 量 长 时 间 停 留 在 饱和 区 。 


仿真 实例 





设 被 控制 对 银 为 : 


S23500 


Co 22000 
一 510070 


采样 时 间 为 Ims。 取 指令 信号 rin(k) =30 ，M =1， 采 用 抗 积 分 饱和 算法 进行 离散 系统 阶 











跃 响应 ， 仿 真 结果 如 图 1-38 所 示 。 取 M =2， 采 用 普通 PID 算法 进行 离散 系统 阶 跃 响应 ， 其 
阶 跃 响应 结果 如 图 1-39 所 示 。 由 仿真 结果 可 以 看 出 ， 采 用 抗 积 分 饱和 PID 方法 ， 可 以 避免 控 
制 量 长 时 间 停 留 在 饱和 区 ， 防 止 系统 产 牛 超 调 。 


“30 。 


Put 


lntegrationController out 
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图 1-38 ” 抗 积分 饱和 仿真 结果 《ad=17 
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图 1-39 普通 PID 算法 进行 离散 系统 阶 跃 响应 结果 (M=27 





仿真 程序 : chap1_15.m。 
#PID Controller with intergration sturation 
Clear all7 


Close al17 


ts=0.001: 

sys=tf(5.235e005, [1,87.35,1.047e004,.0])1 
qsys=c2d(sys, ts, zj1 

[num, denj=tfdatatdsys，vr1z 


U_1=0.07u_2=D0.0:n_3=0.07 





x=[0,0,0] 7 


error_1=07 


Um=63 
kp=0.857ki=9.0;kqQ=0.0: 
Tin=301 #%Step Signal 


for Kk=1:13:800 
七 ime (X)》=Kx*tS7 


utk)=kp*x(1L)+kqyxt2)+kirX(3)7 当 BID Controller 


it uk)>=um 
UK) =Um 

end 

3f ul(k)<=-um 
UK)=-um; 


end 


8Linmear moqel 
youtk (k)=-aen(2)x*y_1-aent3)*y_2-den(4)*yY_3+num(2)wu_L+numt3) UL_2H+HnUI (4 ) UL 3 


errOT (kk) =Tin-yout (kx) 了 





%Using intergraticmn sturation 


“3t1。 


iE utk)>=um 
ifE error{k)>0 
alpha=01 
else 
alpha=11 
end 
elseif (KK)<= 一 ug 
if error(kj>0 
alpha=1l; 
else 


引 LPha=0 





en 
else 
己 LPha=17 


enmd 


elseift M==2 %Not Using intergration SUTaLIOD 
站 LILPha=I: 


EnQ 


&%RetuzrIl cf EID ParameterS 


U_3=D_2D_ 2=n_1;u_L=utk) 1 





y7_3=7_21y_2=Yy_1;YyY_1L=ycuc (tk) 
erLOT_1=error(k)7 

区 (1L) =error (K) 多 Calculating 卫 
x(2)= (ezror(K) -erzCr_1)7LS; 多 Calculating 口 


XI31=x(3)+alphaxrerror (khxbs; 各 CalculacinS 工 


XitKk) =X13) 7 
ena 
Eigurell) 7 


Subplet (311) 7 





Blot (time,rin, 'b' ,kime,yout， rz' 
xlabelt'timelsj')yylabel('position tracking') 
subplot1312) 7 

plot (time ,ul 

xliabel ('time(s)')iylabelt'Controller cutpab 
subplet (313) 17 


咏 Let (LEime 共计， 工 了 





32。 





XlLabetif'timets)' ;ylabel('Integraticon') 1 


1.3.7 梯形 积分 PID 控制 算法 





在 PID 控制 律 中 积分 项 的 作用 是 消除 余 美 ， 为 了 减 小 余 差 ， 应 提高 积分 项 的 运算 精度 ， 
为 此 ， 可 将 窍 形 积 分 改 为 梯形 积分 。 樟 形 积分 的 计算 公式 为 ， 
站 上 上 让 一 
oa=< 人 377 (110) 


0 


1.3.8 变速 积分 PID 算法 及 仿真 


在 普通 的 PID 控制 算法 中 ， 由 于 积分 系数 护 是 常数 ， 所 以 在 整个 控制 过 程 中 ， 积 分 增 量 
不 变 。 而 系统 对 积分 项 的 要 求 是 ， 系 统 偏差 大 时 积分 作用 应 减弱 甚至 全 无 ， 而 在 偏差 小 时 则 
应 加 强 。 积 分 系数 取 大 了 会 产生 超 调 ， 甚 至 积分 饱和 。 取 小 了 又 迟 退 不 能 消除 静 差 。 因 此 ， 
如 何 根据 系统 偏差 人 小 改变 积分 的 速度 ， 对 于 提高 系统 品质 是 很 重要 的 变速 积分 PID 可 较 
好 地 解决 这 一 问题 。 

变速 积分 PID 的 基本 思想 是 ， 设 法 改变 积分 项 的 累加 速度 ， 使 其 与 偏差 大 小 相对 应 : 偏 
差 越 大 ， 积 分 越 慢 ， 反 之 则 越 快 。 

为 此 ， 设 置 系 数 Fe(D) ， 它 是 e(6) 的 函数 。 当 |e(b 增 大 时 ， 了 了 减 小 ， 反 之 增 大 。 变 速 


积分 的 PID 积分 项 衣 达 式 为 : 





人) = 则 各 rokto CL11) 
系数 /与 偏差 当 前 值 |e( 有 | 的 关系 可 以 是 线性 的 或 非 线性 的 ， 可 设 为 ， 
1 |eCO|sB 
Fe(O= 4 有 <|e(e|<4+ 吾 《1.12》 
0 jeGOj> 4+ 避 


了 值 在 0，1] 区 间 内 变化 ， 当 偏差 |e(bj 大 于 所 给 分 离 区 间 4+ 刀 后， 了 =0， 不 再 对 当前 
值 gl) 进行 继续 累加 ， 当 偏差 |e(t 小 于 召 时 ， 加 入 当前 值 go) ， 即 积 分 项 变 为 


到 (有 一 三 六 cor ,与 一 般 PID 积分 项 相同 , 积分 动作 达到 最 高 速 ; 而 当 偏差 |e(tj 在 召 与 ArB 
气 
之 间 时 ， 则 票 加 计 入 的 是 部 分 当前 值 ， 其 值 在 0~|e(bej 之 间 随 |eCb 的 大 小 而 变化 ， 因此, 其 





聊 
积分 速度 在 上 yeGD)T 和 态 > e(D7 之 问 。 变 速 积分 PID 算法 为 ; 
4 各 


4 
H( 大 = 大 pe( 上 二 大 or* oj + 中 [e( 吕 一 eKk-D 《1.13? 


0 
这 种 算法 对 4、B 两 参数 的 要 求 不 精确 ， 参 数 整定 较 容易 。 
仿真 实例 
设 被 控 对 象 为 一 个 延迟 对 银 ; 
33 。 


ea0s 


GOD- 
采样 时 间 为 20s， 延 迟 时 间 为 4 个 采样 时 间 ， 即 80s， 取 如 = 0.45， 局 =12, 太一 0.0048 ， 
4=04,. 引 =0.6。 取 M =1， 采 用 变速 积分 PID 控制 算法 进行 阶 跃 响应 ， 其 结果 如 图 1-40 和 
图 1-41 所 示 。 取 M =2 ， 采 用 普通 PID 控制 ， 其 结果 如 网 1-42 所 示 。 由 仿真 结果 可 以 看 出 ， 
变速 积分 与 积分 分 离 两 种 控制 方法 很 类 似 ， 但 调节 方式 不 同 ， 前 者 对 积分 项 采用 的 是 缓慢 变 
化 ， 而 后 者 则 采用 所 谓 “ 开 关 ” 控 制 。 变 速 积分 调节 质量 更 高 。 
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图 1-40 变速 积分 阶 跃 响应 《4M=1) 
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图 1-42 普通 PID 控制 阶 跃 响应 (44=27 


34 





仿真 程序 ，chap1_16.m。 
$PID Contreoller with changing integraticm at 
Cleat 3117 


close Ball17 


8Big tirme delay Plant 

ts=207 
sys=tft[1],[60,1|，inputdelay' 30) 
svg=c2Q1sSYSuetSs，'Zoh') 


[num,daen]=ttaatatQsys，'V') 7 


D_1=07u_ 2=0;u_3=07U4=07U_5=07 





Y_1=05y7_2=07Y-3=-01 


erTOr_1L=0;error_2=07 





for k=T:1:200 


上 time (k) =k*tsy 
rin (k)=1.0; $SLep Sigmail 


8Linear model 
Yout (tkK)=-dqen (2)*y_1t+tnum(2)*u_5; 


erOT (k) =Tin fk)-ycut(K) 


Kkp=0.457xG=127Ki=D.0D0487 
RA=0 .47B=0.6; 


4T type integration 


ei=ei+terror (K)+errOT_1)72*ftS7 


M=2》 

if M==1 8cChanging integration Tate 

if abs(error (K) )<=B 
丰 (k) =13 

elseif abstexrror(k))>B&absfterror (k) )<=a+rB 
EU)= (AR-abeterror(k))+B)7ai 

else 


皇 (Kk)=07 


= 35。 


emQ 


elseift M==2 aNot changing integration race 
ftK) =11 


en 


UK) =KPpxerTCOr (KJ+KQr* (error(k)~erIOr_1) 7AES+kix* 了 TIK) weiy 


it altk)>=10 
utk)=10; 
ena 
if utkj<=-10 
UK)=-107 
enQ 
8Return of PID Parameters 
u_5=u_4yu_4=u_3;u_3=u_2;u_2=u_liu_l=utk); 


Y_3=y_2;Y_2=y_1;Y_1=ycout (K) 7 


erxrar_2=error_1) 

error_l=error tk 

enG 

figuret1hy 

plot (time,rin,'p' vtime,yout rt 
xiabelt'Eime(s)' ylabel('rinyout') 
Eigmre12) 7 


Plet (time,E，I) 1; 





xtabelf'time{fs)')iylabell'Integration raLe E') 7 
1.3.9 带 滤 波 器 的 PID 控制 仿真 
仿真 实例 一 
验证 低 通 滤波 器 的 主 波 性 能 。 
设 低 通 滤波 器 为 : 
1 
2 DOT 


采样 时 间 为 Ims， 输 入 信号 为 带 有 高 频 正 弦 噪 声 〈100Hz) 的 低频 0.2Hz》 正弦 信号 。 


采用 低 通 滤波 器 滤 掉 高 频 正 丢 信号， 滤波 器 的 离散 化 采用 Tustin 变换 ， 其 Bode 








图 











和 图 1-44 所 示 。 仿 真 结果 表明 ， 该 滤波 器 对 涡 频 信号 具有 很 好 的 滤波 作用 。 
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如 图 1-43 





Bods Diagrams 
From: UCD 








phasetdeg)iesritudef 六 
口 


To 





即 

10? 10” 0 
frequency 《radlsec] 

图 1-43 低 秆 小 波 器 Bode 强 





timets) 
图 1-44 原始 信号 及 滤波 后 信号 


仿真 程序 : chapL_17.m。 
名 LOW PaGR 也 iez 
CiLear BTl1 


clLose altli 


te=9.0017 
Q=ttti11' [@.04.1117 &%DOW FTe 忆 Sigmal 素 斌 Le 工 
Qz=c2QtQvts， Eustin' ) 了 


inumvaen]=ctaatatQ2 4 办 本 





3 


%Inpur Signal with Gisburbanmce 
DIK) -0.10xsint100x2xpivkxks)) 8Disturbance sicmal 
Fintk)=D4K)+0.50xsin(0.2x2xpiwkxts); $%Input Signal 


Yout (k)=-dent2)*y_1+numt1)*rantk+numf2)xT_17 


Y_2=Y_17Y-1=yout (kk) 
F_2=r_1;r_1=rint(k): 

end 

figuretiy;pode(Q) 

figuret2)7 

subplot (211) 1 

pilet (time,rin，rr')i 
xiabeli'time(sl')7ylabel('rin') 
subplor (212); 

plet (time,yout， pb' 7 


Xiabelt'rime(s)')7yzabelf' yout' ) 7 
仿真 实例 二 
采用 低 通 滤波 器 的 PID 控制 。 
设 被 控制 对 象 为 二 阶 传 递 函 数 : 

cc= 523500 

33 +87.3552 +10470s 
低 通 滤 波 器 为 : 
1 
200-008571 

采样 时 间 为 1ms， 干 扰 信 号 加 在 对 象 的 输出 端 。 
仿真 方法 一 


采用 M 语言 进行 仿真 。 分 三 种 情况 进行 ，M =1 时 ， 为 本 加 十 扰 信号 ;，M =2 时 ， 为 加 
上 扰 信 叶 林 加 滤波 ，M = 3 时 , 为 加 干扰 信号 加 滤波 。 阶 跃 响应 结果 如 图 1-45 一 图 1-47 所 示 。 


30， - ，- ,一 











| 

| 

04 0.6 0.8 1 
timefs) 


图 1-45 普通 PID 控制 阶 跃 响应 CaM=1) 
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号 20 
如 
关 
E 0 
-20 和 
0 0.2 04 0.6 08 1 
tmets) 
5 
2 0 
与 _- 
0 0.2 0.4 0.6 0.8 1 
timeds) 
图 1-46 无 滤波 器 时 PID 控制 阶 跃 响应 《4M=2) 
0. _ - 











5 - 本 
0 02 04 06 
tmee) 


图 1-47 刘 入 滤波 器 后 PID 控制 阶 跃 嘛 应 〈M=3) 
仿真 程 


&PID ContToller with Partial Gifterential 





chap1_18.m。 


clear all7 


Close all17 


SS=0.0017 
syS=tt(5.235e005,[1.87.35,1.047e004,0]) 
Qsys=c2Q1sys ts， 二 ) 了 


[num, den]=tfdatatdsys， ww ) 





zu_4=07u_5= 





Y_1=0;Y_2=07Y7-3=01; 


39。 





Orerror_ 2-07ei-0; 

kp=0.20;ki=0.057 

syYs1=cftt[1], 10.04,1])7 外 DOW FreG Signal 了 ie 
Qsys1=c2Q(sYST,tS，'LUSLin ) 了 

[nurmt ,aen1]= 上 faqatatasysl，V 1 


于 1=O7 


Me17 





for K=1L:1:1000 


iimefK)=KxtS 


rimtk)=20; %Scep Signal 


sLinear mode1l 


vouttk)=-dent2)*y_ -denl3)xy 2-aen(0e]*y-3 +Ium(2)*u_ 1+，- - 


Damt3) xn_2+numfd)xu _ 35 


革 E 攻 == 工 &NC Qiasturbance Signmax 
error kk)=rinfk) -yout fk) 
filtyfkl=youttk) 


enq 


Dik)=5.0xranQs (1) 了 &gDisturpbance Signal 


ywout (xl =youttk)+D{k): 


==2 虽 NO 王 L1teL 





El1tYy {K)=YYCuL(K) 
error (Kk) =rin(k) -Etilty(k) 


emQ 





让 KE==3 8USsing 1ow frecuency EL1Kez 
Eilrcy tk)=-den1(2)*f_i+numttl)wtyyouttk)+yy_117 
errcr (k)=rintk)-EiTtytk) 7 


en@ 


SI Separat iorl 





if absferror(k))<=0.8 
el-ei+error (kwLS; 
elSse 
Gei=07 
end 


utfk)=kPxertror(Kk)+kixei: 


if utk)>=30 & Reatricting the output of controller 


end 

和 -一 -----Return Of PID Parameters---------- 
in_l=rinmtk) 

uU_5=u_a:u_a=u_ 3ru_ 3=u 2;u_2=u_1;D_1=ufK) 7 


Y_3=yY_2;Y_2=Y_1;Y_1=yout (k) 7 


4_1=tilty (k) 


YY_1=Yyout (k) 


ETOT_2=erTOr-1; 

ETIOT_1=eILrOI (K) 7 

eng 

Figurcf1)7 

Piob ttime ,rin，'b'vLime filtyw， 
xlabelt'timets) 17Yylabely(t' in yowt 17 
Eiguret23)》 7 

Blor (time ur) 7 
xlabel(t'timets)')7yIabelt' ua) 7 
figuret3) 

DBPLob (time,D， 工 了 


xlabeli'time(ts)')yyIabel('Disturbance signal')， 
仿真 方法 二 


采用 Simulink 进行 仿真 。 控制 器 采用 积分 分 离 PT 控制 , 即 当 误 差 的 绝对 值 小 于 等 于 0.80 
时 ， 加 入 积分 控制 ， 仿 息 结 果 如 图 1-48 和 图 1-49 所 示 。 
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仿真 程序 的 初始 化 程 





图 1-48 


贸 1-49 


chapl 


加 入 总 波 器 时 PID 撕 





无 涉 流 器 时 PLD 控制 阶 跃 响 应 


19f.m 








Simulink 仿真 程序 ，chapl_19.mdl， 如 图 1-50 和 图 1-$1 所 示 。 
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Step1 和 
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Sborstem TranslerFen 




















Diserete Fiter1 





Soope 
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1 





Discrete Time 
ntegrator 


图 151 基于 Simulink 的 PT 控制 


1.3.10 “不 完全 微分 PID 控制 站 法 及 仿真 


人 
各 | 。 abscu) 叫 
St 
去 让 
T Scope1 

















Seope2 


器 子 程序 





在 PID 控制 中 ， 微 分 信号 的 引入 可 改善 系统 的 动态 特性 ， 但 也 易 引 进 高 频 干 拢 ， 在 误 美 
扰动 突变 时 尤其 显 出 微分 项 的 不 足 。 著 在 控制 算法 中 加 入 低 通 滤波 器 ， 则 可 使 系统 性 能 得 到 








改善 。 
Gi(D)=1AL+ 开 9 ， 可 使 系统 性 能 得 到 改善 。 














克服 上 述 缺 点 的 方法 之 一 是 ， 在 PID 算法 中 加 入 一 个 一 阶 惯 性 环节 〈 低 通 滤波 器 ) 





不 完全 微分 PID 的 结构 如 图 1-52 (a)、(b) 所 示 ， 其 中 图 “a) 是 将 低 通 滤波 器 直接 加 
在 微分 环节 上 ， 图 (b) 是 将 低 通 滤波 器 加 在 整个 PID 控制 器 之 后 。 下 面 以 图 (a) 为 例 进行 





仿真 说 明 不 完全 微分 PID 如 何 改进 了 普通 PID 的 必 


冯 
已 。 





.43 。 


















































2 | 和 ro 四 半 
了 ~ 多 一 了 -人 -| 下 末 


如 
if | pr 












































9] 人 
网 1-52 不 完全 微分 算法 结构 图 


对 冬 〈a) 所 示 的 不 完全 微分 结构 ， 其 传递 郴 数 为 ， 


= 全 + 和 下 pr- 《十 丰 (+ 人) (114) 

S 下 +1 ? 
将 式 《1.14) 离散 化 为 ， 

ME = at 人) 十 2 (7 二 ME (天 ) 《1.15)》 
现 将 v (6 推导 : 

8D (3) 一 0) 《1.16) 
写成 微分 方程 为 : 

du 下 derror( 中 


(+ 下 一 和 太 P 


取 采 样 时 间 为 飞 ， 将 上 式 离散 化 为 : 
ap( 训 ) 一 xz 人 (天 一 J 


量 


error( 大 ) 一 errOT 天 一 卫 














up(K) 十 下 = 各 7 邢 (1.17) 
经 整理 得 : 

wo( 昌 = 云 所 加 人 -D+ 去 寻 Cerror( 虽 -emor(k 1) (138) 
令 x= 一 开 _ ， 则 -全 _-1-w， 吕 然 有 a<1，1-&<1 成 立 , 则 可 得 不 完全 微分 算法 


本 
ap( 下 一 天 D(1 一 CJCerror( 丰 一 emror( 炎 一 ] 力 +Cp( 大 一 ]) 《1.19) 
式 中 ，Kp = 局-D/ 有 。 
可 见 ， 不 完全 微分 的 z 如 (和 多 了 一 项 aup( 人 -1D ， 而 原 微分 系数 由 后 降 至 (LI-a) 。 
以 上 各 式 中 ， 们 为 采样 时 间 ，F=Ar， 己 为 比例 系数 ， 邓 和 分 别 为 积分 时 间 常数 和 微 
分 时 间 常 数 ， 到 为 滤波 器 系数 。 
仿真 实例 
采用 第 一 种 不 完全 微分 咎 法， 被 控 对 象 为 时 清 系 统 传递 函数 : 
-803 
60s+1 
在 对 象 的 输出 端 加 幅 值 为 0.01 的 随机 信号 。 采 样 时 间 为 20ms。 


G(9)= 





低 通 泪 波 器 为， 
1 
2 
取 奢 =1 ,采用 具有 不 完全 微分 PID 方法 ,其 控制 阶 跃 响应 结果 如 图 1-53 所 示 。 取 好 =2， 
采用 普通 PID 方法 , 阶 跃 响 应 结果 如 图 1-54 所 示 。 由 仿真 结果 可 以 看 出 , 引入 不 完全 微分 后 ， 
能 有 效 地 克服 普通 PID 的 不 足 . 尽 管 不 完全 微分 PID 控制 算法 比 普 通 PID 控制 算法 要 复杂 些 ， 
但 由 于 其 良好 的 控制 特性 ， 近 第 米 得 到 越 米 越 泛 的 应 用 。 
































1.2 一 -- -一 一 








0 500 1000 “1500 2000 
timets) 


图 1-53 ”不 完全 微分 控制 阶 跃 响 应 af4=1) 











了 500 1000 1500 2000 
timefs) 


图 1-54 普通 PID 控制 阶 跃 响应 〈44=2) 
仿真 程序 ，chap1_20.m。 
%PID Controller with Partial differential 


Clear all7 


close all; 
七 S=201 


sys=tf([1],160,1]，inpurqelay ,80) 1 


Qsys=c2d(SYS,tS，'Zzonh')7 


45 


[num,den] =tfqataftGsys，vV' 7 


u_l=0iu_2=0;u_3=0)u_4=0)u_5=0; 
ud_1=0; 

YY_1=07Yy_ 2=0:Y_3=07 

error_1=07 


ei=07 


for K=1:1:109 


上 ime (K) =Kw 上 SS 


Tinfk)=1.07 


SgLinear model1 


Yout (k)=-aen(2)xy_L+Hnurmt2)*D_S， 


D{k)=0.01*ranqs (1L) 
Yout (kk) =Yout (kj)+D(k) 7 


etITOrIKk)=Tin(K) -yout (khy 


旬 PID ContEroller with partly Qifferential 
eli=ei+ezzoriK)*fS7 

Kc-0O.307 

ki=0.00557 

TDP=1407 


KG=xcx*TDAtLS， 


TFE=18017 

Q=tf([1j,，[Tf,1])) 8Low Freqd Sigmal FilEeI 

M=27 

工 EM== 二 Using PID with Paztial Gifterentiaal 


己 1fa=Gt/A(tS+TE) 
uG(K) =kdq* (1-alfal*terrortk)-error_l1)+alfa*ruQ 17 
UKk)=kcxerror(Kk)+uGQ(kl)+Ki*+eir 
ud_1L=uaitki 7 
elseif M--2 sUsing Simple PID 


UK) =kcreTror(K)+kdrterrorfk)-error_1) kixeiy 


em 


$%Restriceing the Output of conktroller 
if uk)>=10 


tk)=107 
em 
iE utk)<=-10 
fk)=-197 
emnQ@ 


U_5=u_ 4iu_4=u_3iu 3=u_27u_a=u_liu_l=ufkli 





Y_3=y_2;Y_2=Y_1iYyY_1=Yout tk) 
error_1=error{k) 

end 

figuretly 

Blot (tjme,zrin,'bribtime,yout rz 
xlabelf'time(s)' yylapel('rin,yout ) 
figuret2) ; 

Plet ttime ,ua ' 工 ') 1 
xlabelt'time(ts)'):Ylabelft'u 7 
Figuret3y 

Dlot (time,rin-yout rz) 
Xlabelf'time(s) ') ;YILabel('error ) 7 
figuret4) 7 

boae (Q， 工 ' 

qcgainf@r 


1.3.11 微分 先行 PID 控制 算法 及 仿真 


微分 先行 PID 控制 的 结构 如 图 1-55 所 示 ， 其 特点 是 只 对 输出 量 yeut(6) 进行 微分 ， 而 对 
给 定 值 rin(i) 不 进行 微分 。 这 样 ， 在 改变 给 定 值 时， 输出 不 会 改变 ， 而 被 控 量 的 变化 通常 是 
比较 缓和 的 。 这 种 输出 量 先 行 微分 控制 适用 于 给 定 值 Yintj) 频繁 升降 的 场合 ， 可 以 避免 给 定 
值 升降 时 引起 系统 振荡 ， 从 而 明显 地 改善 了 系统 的 动态 特性 。 
令 微 分 部 分 的 传递 机 数 为 : 
bs) Ts+1 
IC5) yps+1 
式 中 ，LCY7ps+D 相当 于 低 通 滤波 器 ， 


Y<1 《1.20) 
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Y7ps 











图 1-55 微分 先行 PID 控制 结构 图 














则 有 
出 dy 
-起 +o= 罗 再 + 》 

由 大 分 得 

dp .、 徊 ( 昌 一 各 伙 一) 

二 了 

加 有人 一 FE 一 

由 了 

7T op 人 各 0 二 二 (= 2- 兴 -了 D， 0 
1 YI7p 加 了 十 了 四 二 加 
oj 全 汪 Jor[ 关 ja 
(=cuae 人 -D+cy( 人 -cy 一] 
其 沾 ， 
as 
YTb + 了 yp + 了 yY7 十 了 
PID 控制 部 分 传递 函数 为 : 
Hpr(S] 工 。 
(9) 一 和 (+ 
式 中 ， 也 为 积分 时 间 常 数 。 
离散 控制 律 为 : 
HK 拉 一 or 有 二 MD() 

仿真 实例 


设 被 控 对 象 为 - 个 延迟 对 象 ; 


es0s 


GD= 
CT 





《1.217 


《1.22) 


《1.23》 


《1.24) 


《1.2S) 


采样 时 间 为 208， 延 迟 时间 为 4 个 采 祥 时 间 ， 即 80s。 采 用 PID 控制 器 进 行 阶 跃 响应 。 输 


入 信号 为 带 有 高 频 干 扰 的 方 波 信号 ，rin()=L0sgn(sin(0.000Srt) 十 0.05sin(0.03rrD) 。 


到 对 =1， 采 用 微分 先行 PID 控制 方法 ， 其 方 波 响 应 结果 如 图 1-56 和 疼 1-57 所 示 。 吏 
M =2， 采 用 普通 PID 方法 ， 其 方 波 响应 控制 结果 如 图 1-58 和 疼 1-59 所 示 。 由 仿真 结果 可 
以 看 出 ， 对 于 给 定 值 rin(k) 频繁 升降 的 场合 ， 引 入 微分 先行 后 ， 可 以 避免 给 定 值 升降 时 所 引 


.48 。 





起 的 系统 振 萝 ， 明 显 地 改善 了 系统 的 动态 特性 。 


fin,yout 





timels) 
和 156 微分 先行 PID 控制 方 波 响 应 《41) 





-15 一 -一 一 一 一 -一 一 一 
站 1000 2000 3000 4000 5000 6000 7000 8000 
timet(s) 





图 1-57 ”微分 先行 PID 控制 方 波 响 应 控制 器 输出 〈M=17 





Tin,yout 





， 四 | 
0 “1000 2000 3006 4000 5000 6000 7000 8000 
timels) 


图 1-58 普通 PID 控制 方 波 响应 〈44=2) 





49 。 











0 1000 2000 3000 4000 5000 6000 7000 8000 
time(s) 
图 1-59 普通 PID 控制 方 波 响应 控制 器 输出 《=27 
仿真 程序 ，chap1_21.m。 


革 PID Controlier with Gitferential in aqavance 
Clear al1: 


CI1oSse 羡 ]17 


七 S=207 
SYSs=tftt[1],160,1]1，inputaelay' ,80) 7 
Qsys=c2d(SYSs,tS ,1 zZOh') 


[nurmu Qenmn] =tfdatalQSsyS， 


U_l1=0:U_3=0:a_3=0:0_4=0zuU_5=0; 
uaQ_1=0; 
Y_1=0jy_2=0)7_3=07 


error_L=07error -2=07 





Eor K=1: 
上 imefKk)=KxtSs: 


400 





&Linear modGeT 
YoucfK)=-qen(2)x*y_ LI+rnumg2)xu _ 5: 


kkp=0.367kq=14;:Ki=0.0021: 


zintk)=1.0Oxaignfsimnt0.00025*2APiIrXxtS)》) 7 
Yintk)=zimtk)+0.0O5xSin(O.03wPpirv 攻 ytS) 了 


erTOFTk)=rin(k)-yout (K) 


ei=ei+error (kj) fs 


gama=0.507 
TQ=ka/7KkP+ 
Ti=0-57 


-50-。 


C1=gamarTqdy(garmarTd+tSsS) 7 
c2=tTQrtSs)/ (gamarTG+tS) 7 


C3=TQA (GarmayTQ+tS) ; 


M=2: 

袜 EM==1 &PID Control with differential in advance 
uatk)=clxrud_ 1+Caryoutik)-c3xy_]17 
tk) =kPxerror (KJ)+uQ (K)+KIxeiy 

elseif M==2 $%Simple PID ConErol 
UKk) =Jkpxerror(k)+kd* (errortK) -erFOL_1) /SS+Kixe7 


end 


if utk)>=110 
utk)=110; 
em 二 
it utk)<=-110 
utfk)=-1107 
end 
&Update Parameters 
u_5=u 4;u_4=u_31u_3=u 27u_2=u_Liru_l=u(k)7 


Y_3=Yy_2;yY_2=Y_1;Y_1=Yout (k) 


error_2=error_ 17 

error_1=errortK) 7 

em 名 

figuret1) 

Plot (timeyrin， rtime,youc bi 
xlabelt'timets)')7ylabeltrinryout ) 
figure(2) 1 

Blot 人 ime az 7 
xlabelt'timetSs)')7ylabelt'u' 7 


1.3.12 ” 带 死 区 的 PID 控制 算法 及 仿真 


在 计算 机 控制 系统 中 ， 某 些 系统 为 了 避免 控制 作用 过 于 频繁 ， 消 除 由 于 频繁 动作 所 引起 
的 振荡 ， 可 采用 带 死 区 的 PID 控制 算法 ， 控 制 算式 为 
0 ol<la 
< |ee> 二 
式 中 ，e(f 为 位 置 跟踪 偏差 ，co 是 -个 可 调 参数 ， 其 具体 数值 可 根据 实际 控制 对 象 由 实验 确 
定 。 普 @, 值 太 小 ， 会 使 控制 动作 过 于 频繁 ， 达 不 到 稳定 被 控 对 象 的 目的 ; 若 eo 太 大 ， 则 系统 
将 产生 较 大 的 滞后 。 

带 死 区 的 控制 系统 实际 上 是 -- 个 非 线性 系统 ， 当 |e(bjj 和 la| 时 ， 数 字 调 节 器 输出 为 零 


。51 























e( 昌 = (126) 

















当 |e(oj> |e| 时 ,数字 输出 调节 器 有 PID 输出 . 带 死 区 的 PID 控制 算法 流程 图 如 图 1.60 所 示 。 
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图 1-60” 带 先 区 的 BID 控制 算法 程序 框图 
仿真 实例 
设 被 控制 对 象 为 


GO = 一 323500 
3 十 87.35s- +104709 
采样 时 间 为 lms， 对 象 输出 上 有 -个 幅 值 为 0.5 的 正 态 分 布 的 随机 干扰 信号 。 采 用 积分 
分 离 式 PTD 控制 算法 进行 阶 跃 响应 ， 取 E = 0.20 ， 死 区 参数 eu=0.10， 采 用 低 通 滤波 器 对 对 象 
输出 信和 号 进行 滤波 ， 滤 波 器 为 : 


1 
20-0081T 


取 失 =1， 采 用 - 般 积分 分 离 式 PID 控制 方法 ， 其 控制 结果 如 图 1-61 所 示 。 取 打 =2， 
采用 带 死 区 的 积分 分 离 式 PID 控制 方法 ， 其 控制 结 来 如 图 1-62 所 示 。 由 仿真 结果 可 以 看 出 ， 
引入 带 死 区 PID 控制 后 ， 控 制 器 输出 更 加 平稳 。 












































2 
壮 
习 1 rm 
呈 上 
0 
0 0.5 1 1.5 2 
timets》 
40 
5 
= 
0 一 wwwweeeeeweeeeeooorwvain 一 一 endl 
- 
1 0.5 1 41.5 2 


tirmets) 
图 1-61 不 带 死 区 PID 控制 (M=1) 


52。 











1 
0 0.5 1 1.5 2 
timets) 





图 1-62 ” 带 死 区 PID 控制 (M=2) 


仿真 程序 : chap1_22.m。 
&FPID Controller with dead zone 
clear all7 


SOse 忆 ]17 


上 ts=D0.QD017 
SYS=tfl5.235e005, [1 ,87.35,1.047e004,0]]7 
世 sYs=c2dQtSYSES， 2 ) 7 


[num, den]=tfdatatdsys，v' ji 


u_l=0iu_2=0ru_3=0;u_4=0iu_5=0; 
Y_1=0;Y_2=0;Y_3=07 

YY_1=07 
error_1=0;error_2=07yei=01 


SyS1=tt([1]，[0.04,1])7 委 LOW FreGr Sigmal 上 ilceI 
dsYys1=c2d(SYS1,，5S8， UStiDn ) 

[numl ,aen1]=tfaata(Qsys1，V' 7 

荆 1=0; 


for K=1:1:2000 
七 ime 其) =Kx 七 号， 


Tint(k)=1; %Step Signal 


S$Linear meoaqel 
yout fxj=-aenf2)]*y_1-den(3)wy_2-dqen(4) wy_3+num(2)*D LT 二 


mnumt3)xu_ 2+num[ajwu_ 37 


.53 。 





Dikj=0.50*Tanmnas[ 1) &%Disburbance Sigmal 


YYout (K) =Yout (k)+DIUK) 7 


8Low _ frequency filter 
filty(k)=-aenl(2}*f_1+numlt1)*(Yyout (k)+yy_1)5 


erreT(K) =Tint(x)-filtyfk)y 





if absfecrorfkj)<=0.20 
edi=ei+error{tk)xts7 
else 
ii=0; 


emD 包 


kp=0.507ki=0.10;kd=0.020: 


UKk)=kpxrerrortk)+kix*rei+Kdrterror(k)-error_31)Ars7 





=27 
宇 EM== 诗 
tki=utk) 
elseif M==2 %Using Dead zone 
IE absferrortky)<=0.10 
utk)=0: 
enQ 


end 


if UK)>=10 
tk)=107 


ena 


8%--------- Return of PID parameters------------ 
Tin_1T=rintK) 


U_3=u_27u_2=u_1;u_1l=u(K)] 





y_3=y_27Y_2=Y_17Y_1=yout (k] 


上 1= 王 iTEY(K) 7 
YY 1-YYout (7 


erEOr_2=erLOI 1 

errOLT_1=erLoI(K) 7 

em 外 

figSuret1)> 

Subplot (211) 7 
.5S4。 


瑟 Iot {timevrin， rtime,Eiltyy，b') 1; 
xlabelt'Eimete)')iylabelt'rinycout') 1 
subplot (212) 

Blot ttimes ur ) 7 
xlabpelf('time(ts)')yylabelft'u'); 
figurel2) 7 

DBPLeE (time,D， 


XlLabelt'time(s)')7Yylabelt'Disturpance signal') 1 


1.3.13 基于 前 馈 补 偿 的 PID 控制 算法 及 仿真 





在 高 精度 伺服 控制 中 ， 前 饥 控 制 可 用 来 提高 系统 的 跟踪 性 能 。 经 典 控制 理论 中 的 前 馈 控 
制 设计 是 基于 复合 控制 思想 ， 当 闭环 系统 为 连续 系统 时 ， 使 前 馈 环 节 与 闭环 系统 的 传递 函数 
之 积 为 1， 从 而 实现 输出 完全 复 现 输入 。 作 者 利用 前 馈 控 制 的 思想 ， 针 对 PID 控制 设计 了 前 
馈 补 偿 ， 以 提高 系统 的 跟踪 性 能 ， 其 结构 如 图 1-63 所 示 。 


辆 TGS) 
四 
区 个 =| mp 卢 =GO3 | cm 下 


图 1-63 ”PITD 前 馈 控 制 结构 















































设计 前 馈 补 偿 控制 器 为 ， 

帮 (9=r(5 5 (1.27) 
总 控制 输出 为 PID 控制 输出 加 前 馈 控 制 输出 ; 

的 二 印 介 十 本 (人 《1.28) 
写成 离散 形式 为 : 

权 人 0 (1.29) 
仿真 实例 
设 被 控制 对 象 为 : 

133 
0 


输入 信号 为 ，r( 如 =0.5sin(6rz) ， 采 样 时 间 为 lms。 


25 
x= 了 1 MDO+T7 
写成 离散 形式 为 : 
三 ( 旨 一 入 罗 + 高 各 
只 采用 PID 二 下 抽 法 的 结果 图 1-64 和 图 1-65 所 示 ， 采 用 前 馈 PID 控制 方法 


5 


的 蹊 跌 结 果 如 


5S6 




















1-67 所 示 。 可 见 通过 前 馈 补偿 可 大 大 提高 系统 的 跟踪 性 能 。 











0.2 0.8 1 


0.4 timets) 0.6 
图 1-64 PID 正弦 眼 踪 (MW=1) 





emor 











02 08 人 


0.4 
timetfs) 


1-65。PID 正弦 跟踪 误差 CM=1) 














0.2 0.8 1 


0.4 ， 0.6 
timets) 
图 1-66_PID 加 前 馈 补偿 正 荡 根 踪 〈M=27 


eror 








0 02 04 


| 0.6 
timets) 
图 1-67”PID 加 前 馈 补 偿 正弦 跟踪 误差 〈M=2) 


仿真 程序 ，chapl_23.m。 
争 PID Feedforward Control11ec 
Clear alli 


close all7 


ts=0.001; 

sys-tf(133, [1,25,0])) 
dsys=c2d(sys,ts，'z7]1 

[num, aen] -tfdacatdsys，v')i 


u_L=Oiru_ 2=0; 





error_1=07ei=0; 
for k=1:1:1000 
time (K) =KxtS7 


=0.57F=3.07 
in (kk) =RxrSsin(FYw2rxDiLYxKx 世 号) 
rin (K) = 站 *FYxDirxCOS (FF* 了 xiwKv 七 三 ) 


ddrintk)=-AxFx2*DpiwFEx2yDpixSintF+2xPi*XxtS) 7 


S$Linear model 


yout (k)=-Gent2)xy_1-den(3) wy_2+num[(2) xu_1+numt3)*U 31 


erraor (k) =rinfxk)-yout (k) 7 


已 i= 马 +eTEOL ( 攻 ) * 七 7 


，57。 


uptk)=80*error(K)+20*ei+2.0*(errorfk)-error_l) /ts 
uftk)=25/133xdrin(k)+lz133x*dqrimn(k)y 


M=21 

if M== 8%Only using PID 
UK)=uptk); 

elseif M==2 $PID+Feeqferward 
utkK)=uptKk)+uE(K) 


em 名 


E utk)>=10 
ufk)=10 

end 

iiE atk)<=-10 
utk)=-107 

end 


uU_2=u_17U_1=uitKk) 
Y_2=y_1)yY_1=yYout (k) 7 
error_1=errortk); 

en 刀 

figure(1) 7 

plot (time,rin，r'vtimeryoeut，b' 1 
Xlapel('time(ts)')iyzlabetf'rinyyout ' )7 
figure(2) 

plot (time,errory ri 
xlabelt'time(s)')1ylabelf'error' 1 
ESgurelt31 1 

DBLoE{time,up，'k' tirme, ur 了 Limey au 7 


xlabpel('time(s)')7y7labelft up utf,u')7 
1.3.14 ” 步 进 式 PID 控制 算法 及 仿真 


在 较 大 阶 竖 响应 时 ， 很 容易 产生 超 亩 。 采 用 步 进 式 积分 分 离 PID 控制 ， 该 方法 不 直接 对 
阶 跃 信 号 进行 响应 ， 而 是 使 输入 指令 信号 一 步 一 步 地 逼近 所 要 求 的 阶 跃 信号 ， 可 使 对 象 运行 
平稳 ， 适 用 于 高 精度 伺服 系统 的 位 置 跟踪 。 

仿真 实例 

设 被 控制 对 象 为 : 

523500 

33 二 87.3552 +10470s 

采样 时 间 为 Ims， 输 入 指令 信号 为 rd= 20 。 采 用 本 控制 算法 进行 阶 跃 响 应 。 其 中 M =1 
58 


GG) = 























时 为 积分 分 离 式 PID 控制 ， 响 应 结果 如 图 1-68 所 示 ，M = 2 时 为 步 进 式 积分 分 离 PID 控制 ， 
响应 结果 及 输入 信号 的 变化 如 图 1-69 和 图 1-70 所 示 。 




















一 
0 0.2 





0.4 0.6 0.8 1 
timefs) 


图 1-68 ”积分 分 离 阶 跃 响 应 〈M=1》 





rd,yout 








0 62 04 0.6 08 
timels) 


到 1-69 步 进 式 积分 分 离 阶 跃 啊 应 〈44=2) 








2 
7/ 
7 
15 上 本 ] 
， / | 
四 / | 
10 / 
2/ | 
5 
， ， 1 
oo 一 - _ JJ 
0 0.2 0.4 timete) 0.6 0.8 1 


”图 1-70 步 进 式 阶 路 信号 rin 的 变化 CAW=2) 
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在 步 进 式 PID 控制 的 仿真 中 ， 实 际 输入 指令 rin( 和 名 采用 0.25 的 步 长 变化 ， 逐 渐 各 近 输入 
指令 信号 rd， 仿 真 结果 表明 ， 采 用 积分 分 离 式 PID 控制 ， 响 应 速度 快 ， 但 阶 路 响应 不 平稳 ; 
而 采用 步 进 式 PID 控制 ， 昌 然 响 应 速度 慢 ， 但 阶 跃 响 应 平稳 ， 共 有 很 好 的 工程 实用 价值 。 





仿真 程序 ，chap1l_24.m。 
&PID Control with Gradual approaching input value 
Clear all7 


Close all 


Cs=O.0017 
SYS=rfi5.235e005, 1.87.35,1.047e004,9]) 7 
Qsys=c2d(sys, ts z) 


[num, den]=tfdataldqsys， vv 7 


1=0:u_2=0iu_3-0iu_4=0:0_5=07 
y_1=0;y_2=0;y_3=01 


error_1=0ierror_2=0:ei=0; 


kp=0.50;ki=0.-057 
:257 





for k=1:1:1000 
time(k)=kwts7 
rd=20; %Step Sigmal 


8Linear moqe1l 
youkt (k)=-dqen12)*y_ 1-den(3)*y_2-dent4) xy_3+num() *a_1+numt3)*U_2+nUm (4)*U_37 


&Using simple PID 





Tin (kh=zdG; 
ErTOT{K) =Tintk) -YeuE(K) 7 
enQ 
if M==2 &Using Gradual apProaching input Value 
iE rini<rd-0-25 
工 半 mn 半 = 工 并 痊 了 二 Kx 七 殷 * 工 3 七 全 
elseif rini>rd+r0,25 
工 mni= 工 InI-Kr* 人 三 急 * 工 羡 上 全 


e1Se 





工 Ini= 工 G; 


eng 


.60- 


Trim(k)=riniy 
error(k)=rint(k) -yout (k) > 


end 


多 PEID with 工 Separation 
if abs(error(k))<=0.8 
人 iei+errOI{K) * 寸 E7 
elgse 
ei=07 
enQ 


uky=kpyerrorfk)+kixeiy 


E ut(K)>=10 


ukK)=107 
enma 
it utk)<=-309 
tk)=-107 
enga 
-~--------- Return of PID ParametereS- 一 - 





rin_1=rintk)7 
U_3=u_2:u_2=u_l1;u_1=ufKk) : 


yY_3=y_21Y-2=y_1;Y_1=Yyout (k) 7 


erTor_2=error_17 





erIOLT_T=error tk) 

end 

figure(t1l) 7 

plot (time,rd, btimeyyout ri 
Xlabelt'time(tsS)')7Y1abel( ra, yout ) 7 
figurel2)7 

plot (time url; 
xlapelt'time(s)');ylabel('u' 7 
Eigure(3) 1 

也 Lo (time,rina， rr) 7 


xlabel('timets)')ylapelt'rin') 7 
1.3.15 PPID 控制 的 方 波 响应 
设 被 控 对 象 为 一 个 延迟 对 象 ; 


-ar 
60s+1 


采样 时 间 为 208， 延 迟 时 间 为 4 个 采样 时 间 ， 即 80s， 被 控 对 象 离 表 化 为 ， 


CG(s)= 





.61 


3?(K)= -den(2)y(K-1D+num2)a(K 类 一 35) 

由 于 方 波 信号 的 速度 、 加 速度 不 连续 ， 当 位 置 跟 踪 指令 为 方 波 信号 时 ， 如 采用 滤波 器 对 
指令 信和 号 进行 滤波 ， 将 滤波 输出 作为 给 定 信 号 ， 可 使 方 波 响应 及 执行 器 的 动作 更 加 平稳 ， 在 
工程 上 具有 一 定 意义 。 

三 阶 离散 滤波 器 的 设计 原理 为 : 

F(z-D=al+aaz 1+az 
2ai +a2 王 1 

取 方 波 信号 为 rin(90 =sgn(0.0001rD ， 滤 波 器 参数 取 m = 0.10,as =0.80 。 

分 两 种 情况 进行 仿真 ， 当 M =1 时 ， 为 普通 方 波 指令 信号 ， 方 波 响应 结果 如 图 1-71 和 
图 1-72 所 示 ， 当 Mt =2 时 ， 为 加 滤波 方 波 指令 信号 ， 方 波 响应 结果 如 图 1-73 和 图 1-74 所 示 。 

可 见 ， 将 方 波 指令 信号 加 滤波 后 ， 方 波 响应 更 加 平稳 ， 控 制 输入 信号 的 封 动 消除 。 


1 





























0 
0 
0 
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Fin yout 


下 








0 05 1 1.5 2 2.5 
ime (s)》 X 10 


图 1-71 普通 方 波 指令 信号 的 PID 响应 〈M=1) 

















0 0.5 1 1.5 2 2.5 3 
Ime (3) 10 


图 1-72 普通 方 波 指令 信号 的 PID 如 制 输入 〈M=1) 


62。 








rin, yout 
Do oo 
口 四 mm 
四 





0.5 1 1.5 2 2.5 3 
time 9) x10 


图 1-73 ” 带 滤波 器 的 方 波 指令 信号 PID 响应 (CM=2) 














0 0 .5 1 1.5 2 2.5 3 
七 ime (s) x10 


图 1-74 ” 带 滤波 器 的 方 波 指令 信号 PID 控制 输入 〈a4=2) 
仿真 程序 ，chap1_25.m。 


$%PID Controller for Square Tracking with Filtered Signal 
clear all17 


C1Los 扎 豆 11 7 


tsS=207 
Sys=tftf1l, [60,1]，inpurdaelavy' 80) 1 
asys=c2d(sys,cs,'zob'); 


[num, den] =tfdatafdsys，V') 


uU_L=Diu_2=0Iu_3=0:u_4=07uU_5=0) 


， 63 。 





Yy_-1=07 
ErrOT_1=D7 

ei=0y 

Fin =0;Tin_2=07 
for k=1:1:1500 


七 me (KK) =KK# 七 避 ; 


Tinfk)=1.0*sign(sinf0.00005*2x*PixykwtS)) 1 


M=17 

Switch M7 

caSse 1 
imnfk) =ringky 

Case 2 
Taintfk)=0.1Dx*riRmtfk)+D. SOxTin 1+0.10YTiD 27 


end 


8TLimnear moael 


yout tk)=-qent2)*y_I+num(2)wu 57 


kp=0.807 
kaq-=10; 
ki=0.0027 


eTTOT (KJ=Tin(KJ-YOUL(OK1T 


ei=ei+errortk]xta， 

UK) =kp*error (kj+kdx (error (K) -error_T)AtS+kiweiy 
&Upaate Parameters 

5=ud4iu_d4=u 3iu_3=u_2;u 2=u_1iu_t-utK) 


Y_1=Yyout (K) 


error_2=error_15 


erTrOY_1=erTorik) 





工 imn_2=Tin .17 
Limn_1=rimfk)7 


enQ 


figuret1) ; 

Blot (time,rin，'K'Eime,yout， Ki 
xlabel{t'time(s)')yvlabel('rzinyout' 7 
figurel2) 

plot (time uk) 
xlabel('timets)');ylabelft'u')7 


1.3.16 ”一 种 离散 微分 -跟踪 器 


韩 京 清 教 授 提出 的 一 种 微分 -跟踪 器 中 ， 其 离散 形式 为 ， 
元 大 + 一 辐 ( 各 +Teo(1 
交大 + 一 加 ( 拉 二 TREE (Da 用 
式 中 ,7 为 采样 周期 ，x(k) 为 第 天 时 刻 的 输入 信号 ，r 为 决定 跟踪 快慢 的 参数 ， 产 为 输入 


信号 被 噪声 污染 时 ， 决 定 总 波 效果 的 参数 。 


fst 函数 描述 如 下 : 
6 = 站，50 = 下，?y= 阅 一 4 十 jc， Go = 652:+8 员 | 
| 十 7 下 全 <6u 
已 +05(a， 6)sign(y) | 诈 >6 
-raf6 加 < 
fst = 
-rsign(a) 区 >5 
仿真 实例 一 


验证 离散 微分 -跟踪 器 的 滤波 性 能 。 





























在 离散 微分 -跟踪 器 中 ， 取 r =1800 ，Ah= 0.015 。 采 样 时 间 为 lms， 输 入 信号 为 幅 值 为 L.0， 
频率 为 10Hz 的 正 沪 信 号 ， 在 该 信号 上 带 有 避 值 为 0.10 的 随机 高 频 干扰 信号 。 采 用 离散 微分 - 
跟踪 器 滤 掉 噪声 信号 。 仿 真 结果 如 图 1.75 和 图 1-76 所 示 。 仿 真 结果 表明 ， 该 滤波 器 对 随机 信 
号 具有 很 好 的 滤波 作用 。 

1.5 
1 
05 
要 0 
5 
村 

-1.58 、 

0 05 2.5 3 


5 
tmets) 


图 1-75 ” 带 噪声 信号 及 滤波 后 信号 
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Ting,xf 











0 0.5 1 1.5 了 2.5 3 
timets) 


图 1-76 理想 信号 及 滤波 后 信和 号 
仿真 程序 :chap1_26.m。 


$FPiTEer With 大 racker andq GjfferentiatIion 
Clear al17 


clese alli 


七 S=-0017 
x=[9,011 
for k=1:1:3000 


二 iime (其 ) = 大 xCS 


0O=T.OxSTnfI+ 了 站 并 yK*S) 了 


U=u9+0.1*Trands (1)7 


工 =18D07 
hz=0.0151 
了 =ts 


Qe1ta=IT*Ii 
Qelta0=QelLax*hy 
Y=Xft1)-u+hxX(2)7 
a0-sdrttdelraxqelta+8Bxrwabsfy)) 7 
if absty)<=GeItra0 
aa=Xf2J+YAnY 
elSse 
a=xt(2)+0.5*fa0-delta)x*signmty) 7 
end 
iE abps(al<=delta 


下 Bt2= 一 工 *QeIay 
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else 
East2= -vsigm() 


ena 


人 1) 汉代) HTYX(2》 7 
X(2)=Xt23+TATSt27 

ring (k) =u0; 

Lintk) =uz 

X1(K)=X(1) 7 

enG 

figure(1l) 

Blet (time,rin，k'vtime, xl k')7 
xlabel('time(s) )7ylabel('rinyxl 
figure(217 

ploc (time,rin0，'K' bime, xl ok' 7 


xtabel('timets) ); ylabel(' rinO,x1Ll') 


仿真 实例 二 
采用 一 种 离散 微分 -跟踪 器 的 PID 控制 。 
设 被 控制 对 象 为 三 阶 传递 函数 : 
ea-= 523500 
53+87.35s +10470s 

采样 时 间 为 Ims， 指 令 信 号 rin(k) = 20 ， 干 扰 信 号 为 0.5rands(D ， 加 在 对 象 的 输出 端 。 在 
离散 微分 -跟踪 器 中 ， 取 上 = 2000 ，A = 0.02 。 采 用 积分 分 离 FI 控制 ， 取 如 =0.12， 太 =0.015 。 
采用 M 语言 进行 仿真 。 分 两 种 情况 进行 : 当 M =1 时 ， 为 加 干扰 信号 未 加 滤波 ， 当 M =2 时 ， 
为 加 干扰 信 号 加 滤波 。 阶 路 响应 结果 如 图 1-77 和 图 1-78 所 示 。 




















40 
E] 20 mr 
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-20 
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图 1-77 无 涉 波 器 时 PID 控制 阶 跃 响 应 及 控制 输入 〈M=17 
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timefs) 
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2 
= | | 
O 
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tmets) 


图 1-78 加 入 滤波 器 后 PLD 控制 阶 跃 响应 及 控制 输入 〈M=27 
仿真 程序 ，chap1_27.m。 


多 PID Controller with Partial Giftferential 
CEBE 己 ] 工 7 


close all7 


ts=0.0017 
sys=-tf15-235e005, [1,87.35,1.047e004,0]) 17 
dsys=c2d(sys,ts， zi 


[num, Gen]=tfqataltdsys，V') 1 


u_1=0Iu_.2=07u_3=07u_4=0;u_5=01; 
y_1=0;yY_2=07Y_3=07 


kp=0.127ki=0.015) 
X=[0,0]7 

for k=1:1:3000 
time (k) =K*t8y 


Tintk)=207 $%Step Signal 


Dinear model 


yout (k)=-dent2)*y_1-den(3)xy_2-den(dj*y_3+mnumt2) xu_i+numf3)xu_2+nurmt4)xa_37 


DIK) =0.50*rancdisftT)) gDisturbance Sigmal 
YYOUL (KJj =YOUC {K)+DIKHI 
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M=21 

EM==1 
iTtY (X) =yyout 

elseif M==， 

r=2000; 

Ph=0.02; 

TtSs 


qelca=rxDhy 
elLa0=GeltarDm7 


SNo Filter 
(KE 


$Using filter with tracker and differentiation 


Y=x(1) -Yyouc tk)+hxex(2): 


a0=sarttdeltardeltarBxrxabsty))， 


if abs(y)<=qelta0 
已 =X(2J+YAh7 


el1Se 


B=X(2)+0.S*(a0-Gelta)*signty) 7 


end 


E abs (ay<=qelta 


fst2=-T*aydelLtay 


elSe 


ESL2=-Fxrsigmnial > 


end 


Xt1L)=X(LTITxX(2)5 
XI{2)] =X(2)+TxESL27 
于 1tY (k)=Xf(1) 


enq 


erTrcIT(K)=Iin(k)- 上 
入 II Separation 


让 有 bs (etOF (上 ) ) < 


LEY(K) 7 


=0.8 


eic=ei+erTOE(K)x 巧 S7 


它 荆 台所 
ei=07 


enqa 


fk) =kpxerror(k)+kixeiy 


if utlk)>=10 
(KJI=103 


ena 


多 Restricring the output of concrollez 
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if utk)<=-10 
QIK)=-107 


engq 


in_1=rintk) 
1_5=a_4ra_4=u_3iuU3=u_27D_2=u_l;U_I1I=uik): 
Y_3=y_2)y7_2=y_1;y_1=yout(k): 

end 

figuretI) 7 

subplot (211) 7 

Plet (fimeyrin。 btirme,fitty，r' 7 
xlabel('Eimefts)');ylabelf' ran,yout ) 7 
subplott212) 7 

DPlot (timev ur) 


xlabelf'timefsl')771abelf ai 


figuref2) 7 

PITOE 人 ime,D， 工 "了 
xIabelf'timetel')jyLIabelIf('Disttirbance signal') 7 
figurel3) 


Plot ttime,yyout，T'vrime,filty，Dbp') 7 


xlabpel('timets)') ;ylabellt'ideal signa1,PFacLical Signal' ) 7 


“7T0 





第 2 章 


2.1 


常用 的 PID 控制 系统 


单 回路 PID 控制 系统 


单 回路 PID 控制 系统 是 指 系统 只 有 一 个 PID 控制 器 ， 如 图 2-1 所 示 。 本 书 所 述 的 大 部 分 
内 容 都 是 关 填 单 回路 PID 控制 系统 的 。 


















































intt +KAerror 人 人 un yout( 
| | PID | DA >| 对 象 一 
Am 
图 2-1 单 回路 PID 控制 系统 














2.2 串 级 PID 控制 


2.2.1 


串 级 PID 控制 原理 


单 回路 PID 控制 系统 的 MATLAB 仿真 见 第 1 章 。 


串 级 计算 机 控制 系统 的 典型 结构 如 图 2-2 所 示 ， 系 统 中 有 两 个 PID 控制 器 ， Gu(s) 称 为 








避 调 节 器 传递 函数 ， 包 围 Gu(s) 的 内 环 称 为 副 回 路 。 Go(s) 称 为 主 调节 器 传递 函数 ， 包 





















































Cats) 的 外 环 称 为 主 回路 。 主 调节 器 的 输出 控制 量 芭 作为 副 回 路 的 给 定量 忆 (s) 。 
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PID2 








串 级 控制 系统 的 计算 顺序 是 先 主 匠 





图 2-2 ” 串 级 控制 系统 框图 











种 是 异步 采样 控制 ， 即 主 回 路 的 采样 控制 周期 嫉 是 副 回 路 采样 控制 周 























串 级 控制 的 主要 优点 : 





5T) 将 干 拢 加 到 副 回 路 中 ， 由 副 世 
(2) 天 回路 中 参数 的 变化 ， 由 副 加 


























周期 相同 。 这 时 ， 应 根据 天 所 











路 控制 对 其 进行 抑制 ; 

















路 《PID1 )， 后 副 回 路 (PID2)。 控 制 方式 有 两 种 : 一 
期 歼 的 整数 倍 。 这 是 
为 一 般 串 级 控制 系统 中 主 控 对 象 的 响应 速度 慢 、 副 控 对 象 的 响应 速度 快 的 缘故 。 另 一 种 是 辐 
步 采样 控制 ， 即 主 、 副 回路 的 采样 控制 
一 回路 的 受 控 对 象 的 响应 速度 较 快 。 

















路 选择 采样 周期 ， 因 为 


路 给 予 控制 ， 对 被 控 量 G 的 影响 大 为 减弱 ; 


71 。 




















(3) 副 回 路 的 惯性 由 副 回 路 给 予 调节 ， 因 币 提高 了 整个 系统 的 响应 速度 。 
副 回 路 是 串 级 系统 设计 的 关键 。 副 回路 设计 的 方式 有 很 多 种 ， 下 面 介绍 按 预 期 闭环 特性 
设计 副 调节 器 的 设计 方法 。 
副 回 路 框图 可 得 副 回 路 闭环 系统 的 传递 函数 为 ; 
卫 ( Ga(aGaGa) 

















百 




















o(Z) 一 





《2.1) 
VD) 1+Goaf(z)Ga(z) 
可 得 副 调 节 器 控制 律 ; 
92(Z) 
Ga(Z) -GducoGy 《2.2) 
一 般 选 搓 
全 (2 一 z 《2.3) 


式 中 ，m 为 Ga(z) 有 理 多 项 式 分 母 最 高 次 宕 。 





2.2.2 ”仿真 程序 及 分 析 


仿真 实例 
设 副 对 象 特性 为 Gx(s)=17Cuws+D ， 主 对 银 特 竹 为 Ci(s)=1A7os+D ，To=To =10， 
采样 时 间 为 23， 外 加 干扰 信号 为 幅度 0.01 的 随机 信号 : 
(和 =0.0lrands(D 
仿真 方法 一 
在 离散 方式 下 进行 仿真 ， 采 用 M 语言 进行 编程 。 按 预期 闭环 方法 设计 副 调节 器 。 由 于 副 对 
象 的 传递 函数 为 一 阶 ， 故 由 式 〈2.3) 得 到 副 回 路 闭环 系统 传递 函数 : 
oa(z)= 2 
主 调节 器 采用 PI 控制 ， 取 总 =1.2, 厂 =0.02 ， 副 调节 器 按 控 制 律 式 (2.2) 设计 。 一 
和 输入、 输出 及 跃 阶 响 应 结果 如 图 2-3 一 图 2-5 所 示 。 


























器 











， 1 轴 了 
0 500 1000 1500 2000 2500 3000 3500 4000 
timefs) 





图 2-3 副 回 路 输入 、 输 出 
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0 1000 00 
timets) 3000 


图 2-4 主 回路 阶 跃 响应 


disturbance 


0 500 ”1000 1500 2000 2500 3000 3500 ”4000 
timets) 


图 2-5 外 加 干扰 信号 
仿真 程序 : chap2_1.m。 


&Serieg System Control 
Clear 117 


close al1; 


上 S=2 7 

SYS1=tEtt(I, [10,1])7 
Gsysl=c2dtsyst,ts，'z 7 
[numl,den1l]=tfaataldqsysl， vi 


sys2=tft1,[10,11)7 
Qsys2=c2d4sys2,ts，' zi 
[numa ,den2]=cfdata(ldsys2，v') 1 


dph=1/zpk('z'vts); 
Gec2=dphy (dQsys2*1f1-qph))7 


[Inump,denp]=tftdatatGc2，vV')7 
。73。 


ul-l1=0.07u2_1=0.0， 
Y1_1=0:Y2_1=07 
e2_1=0;ed=0: 


for Kk=1:1:2000 
上 ime (k)=K*tS7 


zl1(K)=17 
8Linear model 


YUK)=-daentf2)*Y1_ 1+numl(2)ryY2_1: %Main Plant 
Yy2 (kj=-daen2(2)*y2_1+tnum212)*u2_17 $ASSiScant 忆 LIant 


error (kJ)=z1(kK) -YLT(K) 1 
ei=ei+error(k); 


ul(K)=1.2xerTor (KK) +0.02*eiy Main Contreller 


e2(K)=ul(K)-Y2{K)7 RSssistant Cortrol1er 
u2tk)=-aenp(2)*u2_1+nump(1)*e2 (kk)+nump(2)*e2_17 


Q21kK)=0.01*rands (1) 
Uu2 {K)] =u2 (kx)+Q2(K) 7 


- 
ul_1=ul(K) 
u2_1=u2(k): 





e2_1=e2(Kkl7 


Y1-_1L=y1(K) 7 

Y2-1=Y2(X) 7 

end 

figuref1); %Rssistant Control 
Plot (ttime,u1，'P' ime,y2， 工 了 
Xlabel('time(s)') yl1abelft ul y2 1) 


计 iguzetf2)7 多 Madin ContTOL 
ploc (timeyrl, btime yl ri 
xlabelt'timefsS)')zylapelf zlLy1 1) 


figuret31)7 
74。 


地 式 下 进行 仿真 ,仿真 程序 如 图 26 
器 采用 P 控制 






采用 Simulink 进行 编程 ， 在 连 * 
赂 节 器 采用 PI 控制 ， 取 马 =50,A = 






导 Sin(S0f) ， 通 过 切换 开关 的 切换 





大 = 200 。 外 加 干扰 为 正 


从 路 响应 结果 如 图 2-7 和 图 2-8 所 





串 级 控制 ， 








疼 27 常规 PID 控制 的 价 牙 啊 诬 


如 疼 2-8 所 本 


仿 吉 程序 : chap2_2.mdl 


“ 耳 。 

















Manual Suitoh 
1 1 


10er1 1osr1 
TenserFeon | TransferFenz 


















ce 


了 



































Step Pi center 








Secope 














Se wave 。 aint 











图 2-8 串 级 控制 的 Simulink 仿真 程序 


2.3 纯 淆 后 系统 的 大 林 控 制 算法 
2.3.1 大 林 控 制 算法 原理 











时 在 1968 年 ， 美 国 IBM 公司 的 大 林 (Dahlin》 就 提出 一 种 不 同 于 常规 PID 控制 规律 的 
新 型 算法 ， 即 大 林 控制 算法 。 该 算法 的 最 大 特点 是 ， 将 期 望 的 闭环 响应 设计 成 一 阶 惯 性 加 纯 
延迟 ， 然 后 反 过 来 得 到 能 满足 这 种 团 环 响 应 的 控制 器 。 

对 于 如 网 2-9 所 示 的 单 回 路 控制 系统 ，G。(z) 为 数字 控制 器 ，Gy(z) 为 被 控 对 象 ， 则 闭环 
系统 传递 亢 数 为 ; 





-7 Ge(z)Ge(z) 
ADO=RO=TTGOGOOG GGG (2.4) 


3 
(2 全 GO ] 党 











图 2-9 单 回路 控制 系统 框图 
则 有 : 
7(z) 1 人 (2) 
GD= 二 2= 
全 瑟 何 工 9 柯 
如 果 能 事先 设 定 系统 的 闭环 响应 %(z] ， 则 可 得 控制 器 G。(z) 。 大 林 指 出 ， 通 常 的 期 望 闭 
球 响应 是 一 阶 侣 性 加 纯 延迟 形式 ， 其 延迟 时 间 等 于 对 银 的 纯 延 迟 时 间 
4(0)= 了 -7 《2.6) 
及 (5] 7p3g+1 
式 中 ， 了 7 为 闭环 系统 的 时 间 常 数 ， 由 此 而 得 到 的 控制 律 称 为 大 林 控 制 算法 。 


2.3.2 仿真 程序 及 分 析 


仿真 实例 
设 被 控 对 象 为 ; 


.76 。 








(2.5) 





-076s 





Gu(5)= 
人 .4 十 1 
采样 时 间 为 0.3s， 期 望 的 闭环 屈 应 设计 为 : 
了 (eara 
9 ROSS 
4 = 1 时 为 采用 大 林 控 制 算法 ，AM =2 时 为 采用 普通 PID 控制 算法 ， 可 见 ， 采 用 大 林 控 
制 算 法 可 取得 很 好 的 控制 效果 ， 其 阶 跃 响应 结果 如 图 2-10 和 图 2-11 所 示 。 




















D 一 5 一 
9 人 iimets) 





全 2 5 


图 2-10 ”人 林 控 制 算法 阶 跃 响 应 (ad4=1) 








0 





0 5 To imet) 便 20 25 
图 2-11 普通 PIP 控制 算法 阶 跃 响应 (M=27 
仿真 程序 : chap2 3.m。 


#Delay Contrel with Dalin 有 LIgorithm 
clear alli 

close all; 

ts=0.5: 


多 Pant 

Sys1=tftf1],[0.4,I，inputaelay ,9.761)1 
Gsysl=c2d(sYs1,tS  Zzoh') 7 

[numl ,denl1l1=tfdatafasysl，v' 7 


TIT。 


&Tdeal closed Loop 
sys2=tff[il,[0.15,1]，inputaelay' ,0.76] 1 
QGsys2=C2Q(SYS2,S， Zeh ) 7 


sDesign Dalin controller 
dsys=1/dsyslydsys2/1(1-dsys2) 1 
[num,aen]-tftdataftdsys，v' 1 


u_1=0.0;n_2=0.0;u_3=0.0)u_4=0.0:u_5=0.0; 
Y_1=0.07 


erTrOr_1=0.0;error_2=0.0;error 3=0.0; 
ei=O7 

for K=1::50 

七 ime [K) = 区 七 虽 7 


rimntk)=1.07 %Tracing Step Signal 


youE (k)= -denl (2)] *y_1+numl(2)*u_2+num113)*D_31 


errOLT{(K) =Tinfk)-ycut (K) 7 


M=17 

IE M== 8%Using Dalin Methea 

ulky= tnugt1l)*+errortk)+nun(2)*error_1+nhum(3)xerror_2+numi4)*error 3. 
-den(3)*u_l-aentd4)*u_2-aen(5)*u_3-daen(6)*u_4-aent7]*u_5)7dent2) 1 

elseif M== &Using PID MethodQ 

全 = 已 +eTIOE (Kx 上 SS 


utk)=1.0*error(k)+0.10*{ferror(k)-error 1L) /ArSB+O-50*eji7 


enga 


_4;0_4=u_3;u_3=u 210_2=u_1L;uU_1L=u(k) 7 





Y_L=Ycut (kK) 7 


errGr_3=eTTOr_2;1eLrrOT_2=error 17error_1=error(IK) 
eng 
DELOL 人 time iD bp vtime ,you 


xlabell'timefs)')yylabel('rin,yout' ) 1 


2.4 纯 滞后 系统 的 Smith 控制 算法 


在 二 业 过 程控 制 中 ， 许 多 被 控 对 象 具 有 纯 滞 后 的 性 质 。Smith〈 史 密斯 ) 提出 了 一 种 纯 灌 
后 补偿 模型 ， 其 原理 为 ， 与 PID 控制 器 并 接 一 个 补偿 环节 ， 该 补偿 环节 称 为 Smith 预 估 器 。 


7T8 。 





2.4.1 连续 Smith 预 估 控 制 


上 带 有 纯 延 迟 的 单 合 路 控制 系统 如 图 2-12 所 示 ， 其 闭环 传递 函数 为 : 
_YZG) _ Go)Go(s)e 
RD) 1+ GoCJGo(e 天 
其 特征 方程 为 ; 
1 Go(s)Cotp)e =-0 (2.8) 


月 
只 必 
机 ct 站 Cn Ge 了 


图 2-12 带 有 纯 延 迟 的 单 回路 控制 系统 


可 见 ， 特 征 方程 中 出 项 了 纯 延 迟 环节 ， 使 系统 稳定 性 降低 ， 如 果 上 足够 大 ， 系 统 将 不 稳 
定 ， 这 就 是 大 延迟 过 程 难于 控制 的 本 质 。 而 e-= 之 所 以 在 特征 方程 中 出 现 ， 是 由 于 反馈 信号 
是 从 系统 的 4 点 引出 来 的 ， 若 能 将 反馈 信号 从 如 点 引出 ， 则 把 纯 延 迟 环节 移 到 控制 回路 的 外 
边 ， 如 图 2-13 所 示 ， 经 过 的 延迟 时 间 后 ， 被 调 量 了 将 重复 X 同样 的 变化 。 


万 
此 十 
本 人 | 才 -| Go | co 上 


图 2-13 改进 的 有 纯 延迟 的 单 加 路 拧 制 系统 

由 于 反馈 信号 和 没有 延迟 ， 系 统 的 响应 会 大 大 改善 . 但 在 实际 系统 中 , 忆 点 或 是 不 存在 ， 

或 是 受 物理 条 件 的 限制 ， 无 法 从 点 引出 反馈 信号 来 。 针 对 这 种 问题 ，Smith 提出 采用 人 造 
模型 的 方法 ， 构 造 如 图 2-14 所 示 的 控制 系统 ， 
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图 2-14 Smith 预 估 控 制 系统 
如 果 模 型 是 精确 的 ， 即 Go(D) = Cao,z=zm ， 且 不 存在 负荷 扰动 刀 =O， 则 了 =o， 





已 =Y- 如 =0，X = Xu， 则 可 以 用 Xo 代 替 克 作 第 一 条 反馈 回路 ， 实现 将 纯 延 迟 环节 移 到 
控制 回路 的 外 边 。 如 果 模 型 必 不 精确 的 或 是 出 现 负 荷 扰 动 ， 则 X 就 不 等 于 X an ， 
巨 =Y- zx0 ， 控 制 精度 也 就 不 能 令 人 满意 。 为 此 ， 采 用 Eu 实现 第 二 条 反馈 加 路 。 这 就 是 
Smith 预 估 器 的 闵 制 策略 。 

实际 上 预 估 模 型 不 是 并 联 在 过 程 上 ， 而 是 反 疝 并 联 在 控制 器 上 的 ， 因 此 ,将 图 2-14 变换 
得 到 Smith 预 估 控 制 系统 等 效 图 ， 如 图 2-15 所 示 。 
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图 2-15 Smith 和 痪 估 俱 制 系 统 等 效 图 






显然 ，Smith 控制 方法 的 前 提 是 必须 确切 地 知道 被 控 对 象 的 数学 模型 ， 在 此 基础 上 才能 


建立 精确 的 预 估 模 型 





2.42 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为 





Cir)= 
E 50 二 1 


采用 Smith 控制 方法 ， 在 囊 接 制 中 ， 取 大 =40K =0022 ， 假 设 预 测 模型 精确 ， 阶 茎 指 
取 100。Simulink 仿 摧 程序 及 仿真 结果 如 疼 2-16 一 图 2-18 所 示 ， 仿 真 结果 表明 ，Smith 
法 兵 有 很 好 效果 















攻 2-16 Simulink 仿真 程序 





臣 217 不 用 Smil 补偿 的 阶 跃 响应 





图 318 采用 Smith 补 俯 的 阶 寻 克 
仿真 程序 ，chap2_4.mdl， 如 闭 2-13 所 志 


伸 














由 图 2-19 可 得 : 
人) 二 ty 全 )=r() 一 AD) 一 rmt 人 tk) (210) 


若 模型 是 精确 的 ， 则 有 : 


11) 
12) 


浴 An 人 K) 
四 ( 扩 = 六 各 一 xm 人 人) 
et 为 数 这 控制 味 G.ta) 的 得 六 ，G.1z) 一 般 采 用 PI 控制 扯 法 


所 已 


2.4.4 仿真 程序 及 分 析 


仿真 实例 
设 被 探 对象 为 : 








采样 时 间 为 20s 。 

仿真 方法 一 

采 几 M 语言 进行 数字 化 仿真 。 按 Smith 算法 设计 控制 器 。$ 代表 指令 信号 的 类 型 ，S=! 
为 阶 跃 响应 ，S=2 为 方 波 响应 ，M 代表 三 种 情况 下 的 仿真 M =!1 为 模型 不 精确 ，HW = 2 为 模 
型 精确 ，M =3 为 来 用 PI 控制 。 取 SS=2 ， 针 对 HH =1，M =2，M=3 三 种 情况 进行 仿真 。 
在 PT 控制 中 ，5 =0.50, =0.010 。 其 响应 结果 如 图 2-20 一 图 2-22 所 示 。 
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0.5 
| | 
尽 0 
旺 1 
-5| ] 
| | 
了 _ 四 | 
0 2000 4000 6000 8000 10000 12000 


timels) 


图 2-20 ”异型 不 精确 时 方 波 响 应 (44=1) 


1 
1 
0.5| - 
号 . 
有 9 
05 ] 
2000 攻 


1 
0 4000 6000 8000 10000 。 12000 
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阁 2-21 模型 精确 时 方 波 明 应 CU-=2) 
中 一 - 一 - 











2 - | 
0 2000 4000 6000 8000 10000 12000 
timets) 


图 2-22 PI 控制 时 方 波 响 应 CM=3) 
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仿真 程序 清单 : chap2_5.m。 
%Big Delay PID Contrcl with Smith algorithm 
clear all1:close all; 


TSs=207 


$Delay Plant 

JP=1: 

TP=607 

tcl=807 

SYS= 上 tfE( [kKp]，[TP,I]，inputqelay' ,tol) 
QsySs=c2Q143ys,TS， zch' 


[num, Qena]=LfdataltQsys，vV' 1) 


M=Tt 

S$Prediction model 

EM: 
kp1=kpx1L-10; 
TPRIT=TP*1 -107 


1 gNDO Frecise Noqel: FI+Smith 





七 D11=tOl*1T.O7 





elseif M==21M==3 %Precise Model: PI+Smith 





pi=KP7 
TP1=TP7 
toOlI1L=tol7 


em 


SYSs1=tf1Tkpl]，[TP1,1]，inputqelay roll) 
dsysl=c2dtsysl1,Tes，zoh' 1 
[numl ,den1l]=ttdatafdsys1，V 1 


U_I=0.0iu_ 2=0.0:u_ 3=0.010_4=0.0;u_ 5=0-07 
etl_T=07 

ce2=0.07 

e2_1=0.07 


eli=97 
am_1=0.07 
Ym_1=0.07 


Y_1=D,07 


for x=T:1:600 


-83 





0 人 Tracing Step Signal 








Fintk)=eicgnfsintD.0002*2*piykxTsl)7 S%Tracing Square Mave Sigmal 


emnG 

和 PreQiction moael 

xm[(K)=-Genl112)*xpRL LI+numlI2)wuU 17 
ymtk)=-den]1(2)xym_a+numlt2)xu 5 8Wjth Delay 
Yeut (kK)=-aenf2)xyY_1+numt2)*u_ 5 


斌 工 SNO Precise Moqel: PRI+SmitD 





elt(ki=rinftk)-Yyout tkl 1 
e2(k)=elitK) -xmtK)+Ym{tK) 
ei=ei+TSs*+e2fK) 7 
tki)=0.50*e2(k)+0.D010*ey 
el_1l=elfxk)7 
elseif M==2 8%Precise Model: Yout (K)=ym(k})， PI+Smith 
e2(k)= 





nfK) -xm(K) 
ei=ei+Te*e2(kK) 3 
utk)=0.50*e2tk)+0.010*eii 
e2_1=e21(k)7 

elseif M==3 goOnly EI 

el (K) =rin(kl-yout(k) 
ei=ei+Tswel(kK) 7 
utk)=0.50*el(k)+0.010*eiy 
el_1=elfk) 


End 


D_2502=u_ 17 LI=utk) 7 





Y_1=Yout (K) 7 
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仿真 
采用 Sinwlink 进行 数学 
= 站 =0022 。 其 啊 应 结 









仿真 ， 按 Smith 算法 设计 Simulink 模 氮 ， 在 PI 控制 中 


如 固 2-23 和 图 2-24 所 可 





223 Smith 阶 跃 啊 应 结 末 








疼 2.24 
疼 2.24 


仿真 程序 ，chap2_6.mdl， 如 图 2-25 所 
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Delay 




















图 2-25 数字 Smith 预 估 控 制 的 Simulink 仿真 


2.5 ”基于 Ziegler-Nichols 方法 的 PID 整定 


2.5.1 连续 Ziegler-Nichols 方法 的 PIP 整定 


ZicglerNichols 方法 是 基于 稳定 性 分 析 的 PID 整定 方法 。 该 方法 整定 比例 系数 天 的 思想 
是 ,首先 置 及 np = 天 | = 0， 然 后 增加 大， 直至 系统 开始 振荡 《〈 即 闭环 系统 极点 在 ja 轴 上 )， 
再 将 无， 乘 以 0.6， 即 为 整定 后 的 比例 系数 天， 。 

整 记 公式 如 下 : 


KE ，K = (2.13) 





一 0.6K ，Kp = 


式 中 ， 环 为 系统 开始 振 锁 时 的 K 值 ，m 为 振东 频 率 。 
利用 根 轨 迹 法 可 以 确定 天 。 和 只 。。 对 于 给 定 的 被 控 对 象 传递 函数 ， 可 以 得 到 其 根 轨 迹 。 
对 应 穿越 jo 铀 时 的 增益 即 为 六 。， 而 此 点 的 四 值 即 为 On 。 


2.5.2 ”仿真 程序 及 分 析 


仿真 实例 
设 被 控 对 象 为 
一 400 
s(s2 +30s5+200) 

使 用 rlocus 及 riocfind 命令 可 求 得 穿越 增益 Ko=14 和 穿越 频率 mW =14rad/s。 采 用 
Ziegler-Nichols 整定 方法 式 (2.13) 可 求 得 PID 参数 : 

天 =8.8371， 天 b = 0.4945 ， 天 ，= 39.4847 

运行 整定 程序 chap2_7fm， 可 得 图 2-26 一 图 2.28。 图 2-26 示 出 系统 未 补偿 的 根 轨迹 图 ， 
在 该 图 上 可 选 定 穿越 jo 轴 时 的 增益 Ka 和 该 点 的 外 值 ， 即 @n 。 整 定 程序 中 ，sys_pid 和 sysc 
分 别 为 控制 器 和 闭环 系统 的 传递 函数 .图 2.27 示 出 整定 前 后 系统 的 伯 特 图 ， 可 见 该 系统 整定 
后 ， 频 带 折 宽 ， 相 移 超 前 。 图 2-.28 示 出 整定 后 系统 的 根 轨迹 ， 所 有 极点 位 于 负 半 面 ， 达 到 完 


36。 


G(S) = 




















全 稳定 状态 。 
运行 Simulink 控制 程序 chap2_7.mdl， 通 过 并 关切 换 进 行 两 种 方法 的 仿真 ， 可 得 网 2-29 和 
图 2-30， 图 2-29 厅 出 系统 木 补偿 的 正弦 跟踪 ， 疯 2-30 示 出 系统 采用 PID 补偿 后 的 正弦 跟踪 。 
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必 2-26 未 整定 时 系统 的 根 轨 迹 图 
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留 2.27 ”再 定 前 后 系统 的 伯 特 疼 〈 实 线 为 整定 前 ， 虚 线 为 整定 后 
40 一 人 机 








20 
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痉 
一 
时 0 
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Real Axls 


图 2-28 束 定 后 系统 的 根 轨迹 
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图 229 不 定 前 的 








由 230 ”整定 后 的 1 


分 为 PID 正定 程序 和 Simulink 控制 程序 琴 部 分 





仿真 程 ; 





+ chap2_7Tfmm 


38， 





wm=imagtpolet2)17 
KKP=O.6*Km 
xkQG=kpxpi7 (dxwm) 
ji=kp*wm/yPpi 


figuret2) 7 
griqa on' 


podetsys， zl 


SyS_pig=trftf[Kka,kPp,xijv Il,0]) 
SYSC=3Series(SyS, SYSs_Dpidq) 
holq on; 


Doaelsysc，P') 


研 iigukel3) 7 


Flocus (sysc] 


Simulink 控制 程序 ，chap2_7.md1， 如 图 2-31 所 示 。 
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图 2-31 Simulink 仿真 程序 


2.5.3 离散 Ziegler-Nichojs 方法 的 PID 整定 


Ziegler-Nichols 方法 同样 适用 于 离散 系统 的 PID 整定 。 泳 方 法 整定 比例 系数 厨 的 思想 是 ， 
首先 置 Ko=K=0， 然 后 增加 三 直 至 系统 开始 振荡 《即使 系统 的 闭环 极点 位 于 z 平面 的 单位 圆 
上 )， 将 所 得 的 和牛 乘 以 0.6， 即 为 整定 后 的 比例 系数 二 。 

整定 公式 如 下 ， 








AT ，K = (2.14) 


40 开 


中 





天 =0.6K ，KD = 


。89 





式 中 ，Km 为 系统 升 始 振荡 时 的 帮 值 ， On 为 振荡 频率 。 振 荡 频 率 ww 可 以 由 极点 位 于 单位 贺 
上 的 角度 9 得 到 ，mn =67T 《〈T 为 采样 周期 )。 


2.5.4 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为 ， 
1 
< 10s2 +25 

采样 周期 为 T=0.25s。 

采用 零 阶 保持 器 将 对 象 离散 化 ， 使 用 rlocus 及 lecfind 命令 给 出 G(3) 的 根 轨 迹 图 ， 可 求 
得 振荡 增益 生 =11.2604 和 振 污 频率 m。=1.0546 rad/s, 采用 Ziegler-Nichols 方法 ,由 式 (2.14) 
可 求 得 离散 PID 参数 : 

了 =6.7562 ，KD =5.0318， 本 =2.2679 

运行 整定 程序 chap2_8fm， 可 得 图 2-32 和 图 2-33 。 图 2-32 示 出 系统 未 补偿 的 根 轨 迹 图 ， 

在 该 图 上 选 定位 于 z 平面 单位 圆 上 的 闭环 极点 ， 则 求 得 所 对 应 的 增益 玉 s 和 该 点 对 应 的 @n 。 





























RhL ”上 L 


Reaihus 
图 2-32 ”未 下 定时 系统 的 根 轨迹 周 





imag Axis 








Real Axis 
图 2-33 整定 后 系统 的 根 委 迹 图 


台 定 程序 中 ，dsys_pid 和 dsysc 分 别 为 离散 的 控制 器 及 校正 后 的 离散 闭环 系统 。 图 2-33 


“90， 


示 出 PID 整定 后 系统 的 根 负 迹 。 
运行 控制 程序 chap2_8.m, 通过 升 关切 换 M 进行 两 种 方法 的 仿真 , 可 得 图 2-34 和 图 2-35， 
图 2-34 示 出 系统 本 补 偿 的 正弦 跟踪 ， 图 2-35 示 出 系统 采用 PID 补偿 后 的 正弦 跟踪 。 
1r 
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图 2-34 ”整定 前 的 正弦 跟踪 〈MW=2) 


200 250 





frinyout) 








50 300 200 250 


timels) 150 


图 2-35 ”整定 后 的 正 息 跟踪 


仿真 程序 分 为 PID 整定 程序 和 PID 控制 程序 两 部 分 。 
PID 整定 程序 ，chap2_8fm- 

#%PID Controller Based on ZieSler-Nichols 
ClLear LI1; 


cloge alL1: 


ts=0.257 

Sys=tft1l, [10,2,0]) 7 
dsys=c2Q1SYS ES， 2 1) 

[num, aen]=tftdaraldsys， vi 


9] 。 


axiB(' Square' jzgtriGCnew' ) 了 


figuret1) 
zlocustdsys): 


[lam, pole1=rzocfindqfGsvs) 


wm=angle(pole(1))7ts; 
kp=0.6rkm 

kad=kp*piy (4xwme) 
ki=kpywmyp 


Gsys_Dpid=kp+kaxtft[1,-1]，[1,1] ,FSs)+kixtt([10]，[2-1J SirS7 
aaysc=dsysr*dsys_piadl 

FEiguret21) 

zlocus (dsysc) 


ax:s('sqare')，zSriady 


PEID 控制 程序 ，chap2_8.m。 
$PID Controller (20027976) 


Close al1; 


LS=0.257 
SYS=tE(1，[19,2,0])7 
dsys=c2Q1syG,ts， z 7 


[nurm, een]=cfqatatGesys，V' 1) 





error 1=01 


Fotr =1:1:10010 


七 ime (K) =Krx 七 S7 


&Timnt(k)=1.07 
rin(k)=0O.5wsjn(0.025*2yPix*KwS) 7 


多 Linear moae1 


92 。 


Yout (K)=-Qent2y_1-aent3 


ETYOY (K)=rinfk)-youctK) 了 


X(1)=ezTOr (K) 


x(2)=(error(tk)-error_ 1)7ts 


X{3)] =X(3)+erTOL (KK) 七 日 


M=17 
Switch 于 
Case 工 s%Using FID 
fkK)=kpyX(1)+kGxX{2)+KIYX(3) 1 
Case 人 $NO BRID 


utk)=errozrik)7 


enQ 


u_2=u_17 


u_1L=u(X) : 


Y-2=y-_17 
Y_1=Yout (k) 


erLOT_T=etrrOr{K) 7 
ena 


figuret111 


plotttime,rin， pb' ,time ,you 1， 


xlabell'cime(s)') ;ylabelft' (riny yeur) )7 


figurel2)7 


plot ttime rin-yout rz) 


xlabelt'time{ts)') ;ylabel( 


) *Y_2+mnut2)*xu_1+numt3)sD _ 27 


$% Calculating 已 
gs Calculating D 
多 Calculating 工 


。93，。 


第 3 章 专家 PID 控制 和 模糊 PID 控制 


3.1 专家 PID 控制 


3.1.1 专家 PID 控制 原理 





专家 控制 《Expert Control) 的 实质 是 基于 受 控 对 象 和 控制 规律 的 各 种 知识 ， 并 以 智能 的 
方式 利用 这 些 知识 来 设计 控制 器 。 利 用 专家 经 验 来 设计 PID 参数 便 构 成 专家 PID 控制 。 

典型 的 二 阶 系 统 单位 阶 跃 响应 误差 遇 线 如 周 3-1 所 示 。 对 于 典型 的 二 阶 系统 阶 跃 响应 过 
种 进行 如 下 分 析 。 


本 











相 


已 





人 
图 3-1 典型 “ 阶 系统 单 位 阶 跃 罗 应 误 甘 曲 线 

令 e 优 ) 表 示 离 散 化 的 当前 采样 时 刻 的 误差 值 ，e(KE -D 、*e( 引 一 2 分 别 表示 前 一 个 和 前 两 

个 采样 时 刻 的 误差 值 ， 则 有 : 

Ae(=e( 扩 一 et- 
(3.1) 
Ae(KE-D=eKk -TD 一 e( 作 一 2 

根据 误差 及 其 变化 ， 可 设计 专家 PID 控制 器 ， 该 控制 器 可 分 为 以 下 五 种 情况 进行 设计 : 
《1) 当 |e( 名 |> Mi 时， 说 明 误 差 的 绝对 值 已 经 很 大 。 不 论 误差 变化 趋势 如 何 ， 都 应 考虑 
控制 器 的 输出 应 按 最 大 《或 最 小 ) 输出 ， 以 达到 迅速 调整 误差 ， 使 误差 绝对 值 以 最 大 速度 减 
小 。 此 时 ， 它 相当 于 实施 开 环 控制 
(2) 当 e(k)Ae(k) 20 时 ,， 说明 误 差 在 朝 误差 绝对 值 增 大 方向 变化 ,或 误差 为 某 一 常 值 ， 
未 发 生变 化 。 此 时 ， 如 果 |e(6| >MW; ， 说 明 误差 也 较 大 ， 可 考虑 由 控制 器 实施 较 强 的 控制 
作用 ， 以 达到 扭转 误差 绝对 值 朝 减 小 方向 变化 ， 并 迅速 减 小 误差 的 绝对 值 ， 控制 器 输出 可 








= ak-D+ 大 二 攻 CD-ek-D]+5e(D+ 必 GD-2e(-D+eKk 一 2 上 (3.2) 
此 时 ， 如 果 |e(t |<M; ， 则 说 明 尽管 误差 朝 绝对 值 增 大 方向 变化 ， 但 误差 绝对 值 本 身 并 
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不 鼻 大 ， 可 考虑 控制 器 实施 一 般 的 控制 作出 ， 只 要 扭转 误 辩 的 变化 趋势 ， 使 其 朝 误 差 绝 对 但 
减 小 方向 变化 ， 控 制 器 笨 出 为 ， 
M 人 =MK-D+ 和 Eee 于 和 e+ 一 2ek-D+eK-2] (3.3) 
(3) 当 e(DAe(tJ<0、AeU)ae(k -DJ>0 成 者 e(g) =0 时 ， 说 明 误差 的 绝对 值 朝 减 小 的 方 
向 变化 ， 或 者 已 经 达到 平衡 状态 。 此 时 ， 可 考虑 采取 保持 控制 器 输出 不 变 。 
(4) 当 e(FjAe(E)<0、Ae(kjAcek-D<0 时 ， 说 明 误差 处 于 极 值 状态 。 如 果 此 时 误差 的 
绝对 值 较 大 ， 即 |e( 避 | 关 M。， 可 考虑 实施 较 强 的 控制 作用 : 


MD 一 D+TKkoen 人 tk (3.4) 
刘 果 此 时 误差 的 绝对 值 较 小 ， 即 |e( |< M: ， 可 考虑 实施 较 弱 的 控制 作用 : 
昌 =M 人 一 1 十 和 en 人 (人 《3.5) 


《5) 当 |e(b|se 时 ， 说 明 误 差 的 绝对 值 很 小 ， 此 时 加 入 积分 ， 城 少 稳 态 误差。 
式 中 ，en(6 一 -误差 e 的 第 大 个 极 值 ; 

zt( 间 一 一 第 大 次 控制 器 的 输出 

zk 下 -一 -第 上 -1 次 控制 器 的 输出 ， 

太一 一 增益 放 人 天 系数 ， 五 > 1: 

驴 一 一 抑制 系数 ，0< 有 <1; 

af ,4 一 -- 设 定 的 误差 界限 ，4z > Ma ; 

-一 控制 岗 期 的 序号 〈 自 然 数 六 

一 一 任意 小 的 正 实数 ， 

在 网 3-1 中 ，1 、 了 、V、 错 、… 区 域 ， 误 差 朝 绝对 值 减 小 的 方向 变化 。 此 时 ， 可 采取 
保持 等 待 措施 ， 相 当 于 实施 开 环 控制 ， 开 、 玉 、 姬 、 杂 、… 区 域 ， 误 差 绝对 利 朝 增 大 的 方向 
变化 。 此 时 ， 可 根据 误差 的 大 小 分 别 实施 较 强 或 - - 般 的 控制 作用 ， 以 抑制 动态 误 羌 。 





3.1.2 ”仿真 程序 及 分 析 


仿真 实例 
求 三 阶 传递 函数 的 阶 跃 响应 : 
cm> 523500 
9? ”2987.3582 +104705 


式 中 ， 采 样 时 间 为 Ims 。 

采用 专家 PID 设计 控制 器 。 在 仿真 过 程 中 ，e 取 0.001， 程 序 中 的 五 条 规则 与 控制 算法 的 
五 种 情况 相对 应 。 

仿真 方法 一 

采用 M 语言 进行 仿真 ， 仿 真 结 果 如 图 3-2 和 图 3-3 所 示 。 
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0 01 0.4 0.5 


0.2 03 
timefs) 


图 3-2 专家 PID 控制 阶 响 应 曲线 
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0 01 0.2 03 04 05 
timefs) 


图 3-3 ” 误 养 响应 册 线 


仿真 程序 ，chap3_1.m。 
#Expert EID Controller 
clear all; 

close al1; 

ts=0O.0017 


SYS=tf15.235e005, [1,87.35,1.047e004,0])7 
Qsys=c2d(SysS ,LS Z 1 
Enum,qQen]=ttqatatQsys， VD) 7 


D_1=0.07uU_2=0.0:u_3=-0.01 
Y_1=07y_2=0:Y_3=01; 


x=19,0,0] 7 
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x2_1=0) 
Kkp=0.6; 
Ki-0.03， 


KG-0.017 


erTor_1=D7 


for x=1:1:500 





rinfk)=1.01 &Tracing Jieyue Sigmal 


tk)=kPyXx(L)+XdrXIZ2)1*Ki*Xxf3)7 8%ETD CorErOL1Ler 


多 EXDeITL 王 ORETOO1 TI 


jf abs(txfLl))>0.8 &Rulel:Uncloseq control firstlyY 
uiK)=O.457 

elseif abps(x(1))>0.40 
UK)=C-e0; 


elseif abpsftxt1ij>0.20 
uik)=D.121 

elseif abpsitx(]1)>0.01 
urk)=D.10: 


er 


让 x(L)*xf2)>011X(2)==0) 和 RUTe 之 
立 E abstx(1))>=2-05 
uk)=u_1+2*kpyxf1l)7 
昌 1Se 
uIK)=u_1+0.4*kD*XfI1L) 1 


em 


E (XITH*x(2)<Osx(2)*xX2_1>0F1TTXLLT==0) 


1iE xf1)*xf2)<D8x12)*x2_1<0 多 RUle4 
iF abpsftxf1))>=0-05 
fk)y=u +2*KPrerTOT 17 


所 1 马 


当 RaTe3 
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QIkh-u LI+0-6*kprerror 1) 
em 包 


eng 


if abslx(1))<=0.001 Shulcb:lntegration Separation PI control 
utk)=0.5xxft1L)+0O-D010*x(3) 7 


end 


#Restricring the output cf controlier 
if utk)>=19 
utk)=197 
ena 
if ulfkj<=-10 
agej=-197 


ETQ 


g%Linear model1 
Yyouttx)=-aent2lxy-1-qaent3)*y_2-Qentd4lxy_3+num(1lrulk)+num(t2)*u_ 1T+ 
mumf3)*a 2-numfa)su 3 


error(k)=IT2nI(KI-YOut TIKJ 1 


%---------- Return of PID Daramreters------------ 多 





D_IL=aTIKE) 


y_3=y_27Y_2=y_Iry_I=YOUL{K) 7 


XI{t1)=erxor(x) 多 Ca-culating P 
X2_1=x(217 

xf2) =({error (K)-ertror_li/tsr 8% CalculaLing D 
Xf3) =Xxf(3]+errTOF 1(K) < 七 57 多 CalculatirS 工 


erzOT_1-error fk) 了 

end 

Figure(1)7 

Blot Itime,riny brvtime,yout ri 
Xlabelt'timels)')7ylabel('rinyyout')7 
于 iiSuret2)7 

虽 LoE (CEimey IT-YOUE TD 


X1lapelt'tire(s)')rylabel('ezIor' ) 1 
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结果 如 图 3-5 所 可 


仿真 程序 的 S 函数 振 


入 


下 限 及 采 # 


昌 





Simulink 进行 仿真 ,控制 雪 


制 器 参数 、 控 制 输 / 


专家 PID# 


5 






秀 S 本 数 与 Simulink 异 





捉 的 Sirmulink 其 





此 京 PTD 榨 合 阶 乒 玖 话 册 钱 


1 


了 程序 ，chap3_23.m 





棚 结 








全 的 下 


式 实现 


用 封 过 的 形式 设 定 ， 娃 闭 眶 图 如 图 3-4 所 


仿真 





case 3 当 computation cf concrol sigmal 
sy& = mdiOutputs(t,xvuykp,kiykaMTab)i 


Case {I，<，9)} 当 unuseQ flag values 


sys = 门 : 
otherwise % error handling 

errorft ['Unhandled flag = "num2str{fflag)])7 
end 


和 = 





旬 When flLag=0，DPperform SYSLcm InILtialTzation 


名 = 





function [sys,x0,str,tsl] = mdqlInitializeSizesfT) 
sizes = simasizesi & read default conkrol Variables 
sizes.NumcontStates = 0 % no continuous StateS 


sizes.-NumDiscStates =- 3 % 3 States anq assume they are the P/7I/VD ceomponentS 





sizes.NumOutputs = 当 2 output variables: Control utt) anq State X(31 
sizes,NumInputs = 4 # 4 input signals 
sizes,DirFeedthrough = 17% input reflected Qirectly in OutPpur 


sizes.NumSampleTimes =- 1;g% single sampling period 


SYyB = SijimsizesfSizeS) 1 多 

XxO = [9 0 D]7 千 zero initial StatceS 
Sttr = 条 

ca = [-1 0]; gs sampling period 





8 when flag-2，updates the discrete states 


杀 =: 





function sys = malUpdates(xruyT) 
sys=T utL)7 
Xt2)+U(L) Te 
fut1)-ut2))7ZT]7 
Sx (1) :error Value 
S#X{2) :error integratre 


$%x(3) error Qifference 





g When fl1ag<3，Computacres he Durput Signals 





多 = 
function sys = mdlOutputs{t,x,u,kp,ki,kd,MTab) 


i=finatabs(xt1))>MTabf:,1))7 负 RUILeT 
iE tengtnti)>0 
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SYS-MTebfitli 2)7 


已 工 宇 后 





计 Extlix*xl3)>01apsIx(31)<eps) &RUTe2 
DTXtTL) > 用 .05 
sys=uf3)+2xkpwxf1)1 
台电 


SYS=u(3)+O.SxKPwX(I) 


End 


了 (1)*XI3]J<D 和 13)AU Id < 多 RUTe4 


T apbstXxt1))>=3.05 


SYS= (3 +3xYKPYaL2T 


SYS=u(3)+0.6*KDxut2)7 





TI abs(xf]))<=0.0061 &$Ru2e5:Integration SeparatIon PJI control 





SYS=0.Sx*Xft1)+0.010*xft2)7 


eTld 


sys=[sys; xf3)]7 


Simulink 程序 ，chap3_2.mdj， 如 图 3-6 和 网 3-7 所 示 。 
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图 3-6 专家 PID 控制 Simuiink 主 程序 
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图 3-7 专家 PID 摔 制 Simulink 拖 程序 

















3.2 ”一 个 典型 的 模糊 控制 器 的 设计 


3.2.1 模糊 控制 的 基本 原理 


模糊 控制 是 以 模糊 集合 论 、 模 类 语言 变量 及 模糊 网 辑 推理 为 基础 的 计算 机 智能 控制 ， 其 
基本 概念 是 由 美国 加 利 福 尼 亚 大 学 落 名 教授 查 德 (L. A. Zadeh) 首先 提出 的 ， 经 过 二 十 多 年 
的 发 展 ， 在 横 糊 控制 理论 和 应 用 饶 究 方 击 均 取得 重大 成 功 。 

模糊 控制 的 基本 原理 框图 如 了 岁 3-8 所 示 。 它 的 核心 部 分 为 模糊 控制 器 ， 如 图 中 点 划 线 框 
中 所 示 ， 模 糊 控 制 器 的 控制 规律 由 计算 机 的 程序 实现 。 实 现 一 步 模糊 控制 算法 的 过 程 描述 如 
下 : 微机 经 中 断 采 样 获取 被 控制 量 的 精确 值 ， 然 后 将 此 量 与 给 定 值 比较 得 到 误 美 信号 E， 一 
般 选 误差 信号 E 作为 模糊 控制 器 的 一 个 输入 基 。 把 误差 信号 王 的 精 傅 攻 进 行 模糊 化 变 成 模糊 
晤 。 误 养 E 的 模糊 量 可 用 相应 的 模糊 语言 表示 , 得 到 误差 E 的 模糊 语言 集合 的 一 个 子 集 e 〈e 
是 -个 便 糊 矢 旱 )， 厅 由 e 和 模糊 控制 规则 忍 〈 模 糊 算 子 根据 推理 的 合成 击 则 进行 模糊 决策 ， 
得 到 模糊 控制 量 zz : 


































































































站 一 ec 如 《3.6) 

| 1 

1 | ， 模 1 

4 呈请 束 上 如 中 克 | 枪 [on 
- | 变量 处 理 规则 | | 策 | | 处 理 1 
| 传 姑 被 控 对 象 执行 机 构 
图 3-8 模糊 以 制 的 基本 百 理 框 立 

模糊 控制 系统 与 通常 的 计算 机 数字 控制 系统 的 主要 差别 是 采用 了 模糊 控制 器 。 模 糊 控 制 
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器 是 模糊 控制 系统 的 核心 ， “个 模糊 控制 系统 的 性 能 优 党 主要 取决 于 模糊 控制 器 的 结构 、 所 
采用 的 模 粳 规则 、 合 成 推理 算法 ， 以 及 模糊 决策 的 方法 等 因素 。 

模糊 控制 器 (Fuzzy Controller, FC ) 也 称 为 模糊 邮 辑 控制 器 (Fuzzy Logic Controller, FLC )， 
由 于 所 采用 的 模糊 控制 规则 是 由 模糊 理论 中 模 翔 条件 语 多 描述 的 ， 因 此 模糊 控制 器 是 -种 语 
言 型 控制 器 ， 故 也 称 为 模糊 语 兰 控 制 器 (Fuzzy Language Controller，FLC )。 

模糊 控制 回 的 组 成 杠 网 如 图 3-9 所 泵 。 





















































留 3.9 ”模糊 控制 器 的 组 成 柜 图 

41》 模糊 化 接口 〈Fuzzy Interface) 

模糊 控制 器 的 输入 必须 通过 模 灶 化 才能 几 于 控制 输出 的 求解 ， 因 此 实际 上 它 是 模糊 控制 
器 的 输入 接口 。 其 主要 作用 是 将 真实 的 确定 量 输 入 转换 为 一 个 模糊 矢量 。 对 于 一 个 模糊 输入 
灾 最 e ， 其 模糊 子 集 通常 可 以 进行 如 下 划分 : 

e ={ 负 大 ， 负 小 ， 零 ， 正 小 ， 正 人 }={NB,NS,. Z0, PS,PB1 
={ 负 大 ， 负 中 ， 负 小 ， 霉 ， 正 小 ， 正 中， 正大 }={NB, NM, NS, ZO, PS,PM,PB} 
={ 大 ， 负 中 ， 负 小 ， 零 负 ， 孝 正 ， 正 小 ， 止 小 ， 下 大]={NB, NM, NS, NZ, PZ, PS, PM， 








1 


PB} 
用 三 角形 束 属 度 函 数 表示 如 岁 3-10 所 示 。 








图 3-10 ”模糊 了 集 和 模糊 化 等 级 


(2) 知识 库 (Knowledge Base，KB ) 
知识 库 由 数据 库 和 规则 库 两 部 分 构成 。 
aa 数据 库 Data Base，DB) 数据 库 所 存放 的 旦 所 有 输入 、 输 出 变量 的 全 部 模糊 子 集 
的 隶属 度 撩 量 值 (经 过 论 域 等 级 离散 化 以 后 对 应 值 的 集合 ), 苦 论 域 为 连续 域 则 为 隶属 度 函 数 。 
在 规则 推理 的 模糊 关系 方程 求解 过 程 中 ， 向 推理 机 提供 数据 。 
8 规则 库 〈Rule Base，RB ) 。” 模 帆 控 市 器 的 规则 基于 专家 知识 或 手动 操作 人 员 长 期 积 
累 的 经 验 ， 它 是 按 人 的 直觉 推理 的 一 种 语 二 表示 形式 。 模 灶 规 则 通常 由 -系列 的 关系 词 连 接 
而 成 ， 如 半 then、else、also、end、or 等 ， 关 系 间 必 须 经 过 “ 翻 译 ” 才能 将 模糊 规则 数值 化 。 
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常用 的 关系 词 为 让 then、also， 对 于 多 变量 借 糊 控制 系统 ， 还 有 and 等 。 例 如 ， 某 模糊 控 
制 系统 输入 变量 为 e《〈 误 益 ) 和 ef【〔 误 差 变化 )， 它 们 对 应 指 语 言 变 盟 为 吾 和 BC， 可 给 出 一 
组 模糊 规则 : 

RCIFEiSNB andECisNBthenUis PB 
R2IFEis NB and ECisNS ihen Uis PM 

通常 把 让 … 部 分 称 为 “前 提 部 ” 而 then… 部 分 称 为 “结论 部 ” 其 基本 结构 林 归 纳 为 开 A 
and B then C， 其 中 4 为 论 域 已 上 的 -个 模糊 子 集 ， 召 是 论 域 了 上 的 “个 模糊 子 集 。 根 据 人 
工控 制 经 验 ， 可 离线 组 织 其 控制 决策 表 灵 ,及 是 笛 卡 儿 乘积 集 世 xyY 上 的 一 个 模糊 子 集 ， 则 某 
一 时 刻 共 控制 量 由 下 式 给 出 : 

C=(4Xx 吾 )o 亚 《3.77 

式 中 ，x 一 一 模糊 直 积 运算 ; 
模糊 合成 运算 。 

规则 库 是 用 来 在 放 全 部 模 糊 控制 规则 的 ， 在 推理 时 为 “推理 机 ”提供 控制 规则 。 由 上 述 
可 知 ， 规 则 条 数 和 模糊 变量 的 模糊 子 集 划 分 有 关 ， 划 分 越 细 ， 规 则 条 数 越 多 ， 但 并 不 代表 规 
则 库 的 准确 度 越 高 ， 规 则 库 的 “准确 性 ”还 与 专家 知识 的 准确 度 有 关 。 

(3) 推理 与 解 模糊 接口 〈《Jnference and Defuzzy-interface) 

推理 是 模糊 控制 器 中 ， 根 据 输 入 模糊 量 ， 由 模糊 控制 规则 完成 模糊 推理 来 求解 模糊 关系 
方程 ， 并 获得 模 精 控 制 量 的 功能 部 分 。 在 模糊 控制 中 ， 考 虑 到 推理 时 间 ， 通 常 采用 运算 较 简 
单 的 推理 方法 。 最 基本 的 有 Zadeh 近似 捧 理 ， 它 包含 有 正 向 推理 和 逆向 推理 两 类 。 正 向 推理 
常 被 用 于 模糊 控制 中 ， 而 逆向 推理 一 般 用 于 知识 于 程 学 领域 的 专家 系统 中 。 

推理 结果 的 获得 ， 表 示 模 糊 控制 的 规则 推理 功 能 口 经 完成 。 但 是 ， 至 此 所 获得 的 结果 仍 
是 -- 个 模糊 矢量 ,不 能 直接 用 来 作为 控制 星 , 还 必须 进行 “次 转换 ， 求 得 清晰 的 控制 基 输 出 ， 
即 为 解 模 糊 。 通 常 把 输出 端 具有 转换 功能 作用 的 部 分 称 为 解 模 糊 接 口 。 

综 上 所 述 ， 模 糊 控制 器 实际 上 是 依靠 微机 〈 或 单片机 构成 的 。 它 的 绝 大 部 分 功能 由 计 
算 机 程序 来 完成 。 随 着 专用 模糊 芯片 的 研究 和 开发 ， 也 可 以 由 便 件 逐步 取代 各 组 成 单元 的 软 
件 功能 。 


口 

















3.2.2 ”模糊 控制 器 设计 步骤 


模 精 控 制 器 最 简单 的 实现 方法 是 将 一 系列 模糊 控制 规则 离线 转化 为 一 个 查询 表 〈 又 称 为 
控制 发 )。 存 储 在 计算 机 中 供 在 线 控 制 时 使 用 。 这 种 模糊 控制 其 结构 简单 ， 使 用 方便 ， 是 最 基 
本 的 一 种 形式 。 本 节 以 单 变 基 二 维 模糊 控制 器 为 例 ， 介 绍 这 种 形式 模糊 控制 器 的 设计 步 又， 
其 疏 计 思想 是 设计 其 他 模糊 控制 器 的 基础。 

(1) 模糊 控制 器 的 结构 

如 前 所 述 ， 单 变量 二 维 模糊 控制 器 是 最 常见 的 结构 形式 。 

02) 确定 异 糊 控制 嚣 的 结构 

单 变量 二 维 模糊 控制 器 足 最 常见 的 结构 形式 。 对 误差 刀 、 误 差 变化 EC 及 控制 量 2 的 模 
糊 集 及 其 论 域 定义 如 下 : 

互 、EC 和 的 模糊 集 均 为 ，{NB,NMNS,Z,PS,PM,PB} 

五 、EC 的 沦 域 均 为 : {-3, -2 -10,1,23j} 
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的 论 域 为: -4.5, -3，-1.5.0, 1, 3, 4.5] 

《3》 建 立 模糊 控制 规则 

根据 人 的 直觉 思维 推理 ， 有 系统 输出 的 误差 及 误差 的 变化 趋势 来 消除 系统 误差 的 模糊 控 
制 规则 。 模 糊 控 制 规 则 语句 构成 了 描述 众多 被 控 过 程 的 模糊 模型 ， 例 如 ， 卫 星 的 姿态 与 作用 
的 关系 ， 飞 机 或 舰 船 航向 与 舵 偏 角 的 关系 ， 工 业 锅炉 中 的 压力 与 加 热 的 关系 等 。 因 此 在 条 件 
语句 中 ， 对 于 不 同 的 被 控 对 象 ， 误 差 召 、 误 差 变化 EC 及 控制 量 & 有 不 同 的 意义 。 

(4) 确定 模糊 变量 的 赋值 表 

模糊 变量 误差 召 、 误 差 变 化 EC 及 控制 量 & 的 模糊 集 和 论 域 确定 后 ， 须 对 模糊 语言 变量 
确定 隶属 函数 ， 即 所 谓 对 异 糊 变量 赋值 ， 就 是 伺 定 论 域内 元 素 对 模糊 河 言 变量 的 隶属 度 。 

(5) 建立 模糊 控制 表 

上 述 描写 的 模糊 控制 规则 可 采用 模糊 规则 表 《〈 见 表 3-1) 来 描述 ， 共 49 条 模糊 规则 ， 各 















































个 模糊 语句 之 间 是 或 的 关系 ， 由 第 -条 语句 所 确定 的 控制 规则 可 以 计算 出 由。 同 理 ， 可 以 由 
其 余 各 条 语句 分 别 求 出 控制 虽 wz，…, ws9， 则 控 肖 | 量 为 模糊 集合 &， 可 表示 为 ; 
下 一 在 1 二 了 2 十 十 开 49 《3.8) 
表 3-1 ”模糊 规则 表 
< 
四 NB | NM zl mi Pd | P 
ee 

NB PB | P | P | m | | zolzo 

NM PPe | | | ms | zo | ws 

NS ML PM PM PS ZO NS NS 

2z0 PM | PM | mazo | | NM | NM 

PS FE | m | zol | | NM | NM 

PM PS | zo | NS | NM | NM | NM | 了 

PB zo | zlmlmn|lm| 昌 | 





























(6) 去 模糊 化 

由 式 (3.8》 计 算出 的 模糊 控制 量 可 以 选用 一 种 判决 方法 ， 如 采用 最 大 隶属 度 方法 ， 将 控 
制 基 由 模糊 量变 为 精确 基 。 为 了 获得 准确 的 控制 量 ， 就 要 求 模糊 方法 能 够 很 好 地 表达 输出 隶 
属 度 函 数 的 计算 结果 。 本 文采 用 工业 控制 中 广泛 使 用 去 模糊 方法 一 加 权 平 均 法 。 该 法 针对 论 
域 中 的 每 个 元 素 如 (LE=12.…:)， 以 它 作 为 待 判 决 输出 模糊 集合 的 隶属 度 AD 的 加 权 系 数 ， 即 


取 乘 积 xMGD) ， 再 计算 该 乘积 和 立 xHtG) 对 于 束 属 度 和 的 平均 值 xo ， 即 ， 





立 su0 
_- 吉 


六 pa 


平均 值 2 便 是 应 用 加 权 平 均 法 为 模糊 集合 求 得 的 判决 结果 , 最 后 ， 用 输出 量化 因子 乘 以 


2 (3.97 
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2 以 适应 控制 归 求 ， 从 而 可 得 到 控制 量 的 实际 值 。 
3.2.3 ”模糊 控制 器 设计 实例 


根据 上 述 步骤 ， 设 计 二 输入 单 输出 模糊 控制 仿真 程序 。 输 入 为 偏 美和 偏差 变化 率 ， 输 出 
为 控制 信号 。 通 过 仿真 得 到 控制 器 的 响应 表 如 下 : 


fazzy controller tabje:e=[-3,+3],ec=[-3,+3] 
Ulist = 


忆 二 二 
口才 
hb nb 岂 岂 站 
oa 二 六 
wm 一 
wm wb 


运行 plotfis(a2)， 得 到 模糊 推理 系统 ， 如 疼 3-11 所 汞 。 系 统 的 输入 输出 隶属 度 函 数 如 
图 3-12 一 图 3-14 所 示 。 





ec (77) 


System fuzi: 2inputs, 1 outputs, 49 rules 


阅 3-11 模糊 推 地 系统 











图 3-12 偏 养 求 属 度 函 数 
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所 
喜 
名 
每 
号 
后 
印 
E 
后 
8 
所 
豆 
吕 
口 





2 0 1 2 3 14 
U 


图 3-14 ”控制 器 笨 出 求 属 度 男 数 
仿真 程序 中 模糊 控制 器 的 设计 : chap3_3.m。 


#Fuzzy Centroller 





clear al 


Clcse al11; 
anewtjsf "EuzzT') 


fl1=17 

ac=addvar(a,'input'，'e'，[-3*f1,3*ftl])17 ParameteI 所 
aa=adgGmf ta, input' ,1，'SB' 2zImE IE-3*fl， -1*t3])7 

ac=addmt ta, 'input' 1， NM'， Erinmft' ，[-3* 丰 -2*fl,0])7 
aa=aGdmf (ainpur' 1 NS'，'Erirmt'，[-3xf1，-1*fT，1xE1] ) 
ac=addmf(ta，'input' 1, 2，'Lrimf'，[-2xf1 0,2x*f1])7 
ac=ademfta'irnpuL' ,1, PS，'trimE' LI-1*s1l lwE13*S1]1) 1 
=addmFta input' 1， PM' Erimf' [U,2*f] ,3*E1]) 

ac=addmt ta 'input' 1,'PB' ysmf' [1YE1 ,3*E17 》 
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王 2 = 二 > 
a=adavar (ainput'y'ec'，I-3*f2,3x*f2])7 $%Parameter ec 
as=acdmf (ainput' 2，NB'，zmF'，[-3+f2-1*f2]) 7 


a=addmf (a, 'input' ,2，NM'，'ttimt，[-3*f2，-2xf2,0]) 7 
a=adqdmf (ainput' 2，NS'，'ttimft"，[-3*f2，-1L*E2，1IxE2]) > 
a=addmf (aa input' 2 Zrimf' fi-2xf2,0,2*f2]1) 
a=adqdmf (ainput' 2， PS'， ErimEt [~-1Lw*E2，1wf2 ,3*f2]117 


araddmf(a'input' ,2,'PM'，'Erimf [02*f2，3*f2]17 
a=addmf ( 忆 ， input' 2，'PB'， Smf [LI*t2，3*+*f2))7 


f3=1.5; 

ac=aqdqvar (aoOutput ay，[-3*f3，3*f3])7 和 Parameter 襄 
a=aqdmf(a， output '，1，NB'，'zrmf' [-3xf3,， -LI*f3]) 7 

已 =aGdmf (和 Output 1， NM' trimf'，[-3*E3，-2xf3，0]) > 
a=addmf (fa 'output' ,1,，'NS' trimE'[-3*t3，-1*f3,1wf3])1 
a=addmf (a,'output' 1, 2， trimf"[-2xf3,0,2*f3])7 
as=aqdmf (aoutPput' 1, PS' trimf'，[-1*f3，1xf3，3*f3]) 7 
a=addmf (a,'output' ,1，'PM'，Etrimt' [0,2*f3,3wf3]) 7 
ac=addmf (a,'output' ,1,'PB'，'smt'v[1*f3,3*f3])7 


rulelitst=[1] 1 1 1 17; %Eait rule base 
12111: 
13211; 
14211; 
15311; 
工 63211; 
1174711; 
21111; 
22211: 
23211:; 
243117; 
253115; 
264115 
27511; 
31211; 
32211 
333117 
3431; 
3541317 
365117 
3735117 
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41211; 
42311; 
433217 
和 41 1 
4551 了 7 
455S127 
437611; 
5131317” 
52312， 
53411 
54511; 
5551; 
55611:; 
573B61127 
6 工 T 1 
53& 和 117 
635157 
器 45 17 
65656511 
号 五 611]7 
56567711; 
714115 
了 了 251 

了 35S1 
746117 
5511F 
76573115 
733111 


a=aadrulela,Tuleliest)i 


多 Showru1e ta) 和 Show fuzzyY rule base 
al=setfigs(ta DefuzzMethoa'，'rmomn'); & Defuzzy 
wricefistal， Euzzf') 1 & Save to fuzzy file "fuzzft.fis” which can be 


名 SimeclateaG with fuzzy tool 


a2=TreadQfisf'fuzzE' 7 


一 [ -3,+31rec=i-3Tr3] ) 





qispf'fuzzy controller FablIei 


Uiist=zeros(7 ， 7) 
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foz ii=1:7 
for j=1:7 
eti)=-4+i 
ectj)=-d4+j; 
listfiy, jl=evalf:2s([efti)vectj)]va2)7 
end 


end 
Uliskc=ceil(UIisc) 


于 Sure(1) 
plotfjista2); 

于 iiguref21 

plotmf(ta input' 1); 
figuzet3) 

nput" 217 


figure(dh 


《 

【 
plotmf ta， 

(4) 
plotmf ta 'outPput' ,1)7 


3.2.4 模糊 控制 位 置 跟 踪 


仿真 方法 一 ， 模 糊 控 制 位 置 跟 踪 的 仿真 
被 控 对 象 为 ; 





3 十 255 
采样 时 间 为 Ims， 采 用 z 变换 进行 离散 化 ， 经 过 z 变换 后 的 离散 化 对 象 为 : 
yout( 旬 = -den(2)yout( 民 一 D 一 den(3)yout 代 一 六 + num(2)u( 大 一 D 十 num(3)2z(K 一 2) 
针对 离散 系统 的 方 波 位 置 响应 ， 运 行 模糊 控制 器 程序 chap3_4m， 其 中 反 模 糊 化 采用 
“Centroid” 方 法 。 方 波 响应 及 控制 器 输出 结果 如 图 3-15 和 图 3-16 所 泵 。 


上 





0.5 


minyout 
口 





0 ”05 


荆 
Timetsecond) 


图 3-15 方 波 啊 应 
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2 
1 
= 0 
- 
-2 - 1 
1 
Time(second) 2 
图 3-16 控制 器 输出 
仿真 程序 ，chap3_4.m。 
FUZZY ConErc11Ler 
Clear alTiclose all: 
Ba=newfis{(' fuzz_13k') 7 
人 1=1.07 
as=aqdvatr (ar'input ' ， ef-3xf3，3xf2]1)7 要 PaTRSmeGtet 所 


Ba=aadmf (ainput vv 1 NB ZmE' ，[-3*f]1 -1* 芋 1] 7 
Ba=acldmf (input TI， NM'， trimt'，[-3*fl, -2*f1,0])7 
a=addmf{fa，input'v1，NS'， tr:rmt'，[-3x+xfl，~1Ixfl,IxEfl]) 7， 
as=accmf ta，inputr' 1 ZrimE' rr [-2x*fl1,0, 2*E1))》 7 
a=addmf (ar ' inpuc' ,TI PS' ETinE ，[-1*f1, TvE]1， 了 YE2]) 7 
a=addmt (ainput ,1 PM'，'trimt [0,2*f1,3* 下 1) 7 
Ba=acGdmf (ainput' ,上 PB'，'smf' TI1*FL，3xE1]) 7 


f2=1.5; 

a=adavarta'input' ec'y[-3rf2,3rf2])1 Parameter ec 
aa=aadamf (ainput' 2 NB 2zmE ，[-3*f2 -LI*f21)7 

a=adamf ta 'input' 2，NM' trimfr [-3xft2，-2xrf2，0]11 

ac-=addqmflar 'input' 2，'NS' trimft，，[-3+f2,-1*f2，1xf2])7 

ac=aqdmtf{ta，' input' 2，' Zrimf'，I-2*f2，0D,2*f2]) 7 

ar=aQdqdmg (ainput' 2， PS3' rimft -1*E2，1*2，3*xf2]》 7 

=aqQdmf ( 忆 input' ,2,，'PM' trimft"， [DO ,2*f2，3*f2]1)7 

aa=adqdmE (ay inapBut' 2 1PBI SmE' TI1Lxf2 3*2])》 7 


多 E3=] 47 
王 3= 工 .5 


a=acdqvar (aa :OutPUL '，' aa [-3*f3，3*E3]) 7 多 aratteter 忆 


"1I1。 


asadamf ( 蛋 ，， Output' ,1，NB'，'ZIf'，[-3*f3，-1*rf3])7 
as=addmt [aa，output' 1, NM trimf'，[-3w*ft3, -2xt3,0])7 
a=addmt (aa ' Output' ,1，NS'，'trimf' -3xf3, -1*f3,1xf3])7 
=aadmt ( 己 ，， outpat' 1， 2 trimf'[-2*f3 9，2xf3])1 

已 =adQdmf ( 己 ，OUEPUE ' ,1 ，'PS' Eight [- 工 xf3 





于 3 ,3xf31 ) 
zirmE [0 2yf3，3xf33) 
SmE [1*E3，3xf3])》7 





a=adqdmf (二 ,eutPuUL' 1， PM 
&=adqcmt (acourput' ,1,，'PB 


%Each rule is a FED rule: error=trin-yout (nagative feedback) 


ruielist=[ 工 吏 Rdit tule base 


四 Phpphn nba 
已 


NI AN 
四 
mmaea nu 





上 mm 


人 
本 
中 





CO 


相 
IE 
mw wm 


工 
1 
工 
1 17 
工 
工 
工 
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om 
Di 一 
避 园 四 
让 ”Rh PP hb 
加 上 上 


人 
mb 
Pu 


本 








愉 =aqdarulel(aIaleLStrl 1 


色 Showrulelal) 和 旬 Show fuzzy 上 -Te base 


ai=cetfista, ,DefuzzMerhod' cecstroia'); 名 Defuzzy 

wrikesistal,'1jk') 7 当 save :oo fuzzyw file "1jk.fis” which can be 
读 simulared wiih T2zxy tocl 

aa2=reaafss( ijK) 


&Dplotfista2]17 


$fuzzy 1Jk.fis Demo fuzzy contrcl Simelation 


杀 fulLeviecwfa21: 


寺 于 和 第 和 史 贡 是 S ing PuZZY CODH 工 OL 人 G 工 和 和 和 和 和 
sys=cf(5.235e005, [1,87.35,1.047e004,0])7 
dsys=c2G(sys 0.001，z 1 
taumvaenj=tfaatalGsys，v' 
LU_1=0.07u_2=0.0:0_3=C.D7 
Y_1=05y-2=07y_3=07 
”113。 








for Kk=1:1:2000 


上 time (K}=Kwcsy 

zintk)=l*signfsjin(I*2*pixjkcxtSs)) 8Tracing Fangbo Sigmal 

Yout tk)=-aen(2jxy_1-dent3)*y 2.den(4jxy_3+num(2) *a_1+num(3)*u_2+num(4) wa 31 
error (Kj=youttk)-rinfk) 7 


ei=ei+rerror(k)xts， 


uk)=evalfis([e-1 ec_l],a2) &Using fuzzy imnferemnce 





2=u_17 
U_L=utk) 7 


YY-3=Y-21 
Y-_2=Y_ 1 
Y_1=Yout(Kk) 





e_l=erzor(k) 


多 ec_T={erroT (K)-erTor_1) /ts 


ec_1=errer(k) -error_1: 


error_2=errer_1; 

erOT_1=error(K] 1 

ena 

figure(1) 7 

DBLot (time,rin,'b' vtimeyout，T')7 
xliabel('Timelsecond)j')iylabelt'rinryout') 1 
figuret2) 7 

plot (timey ur 


xlabelt'Timelsecondj' 1:Ylabelil'u 
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仿真 方法 二 :楼 黎 控 制 位 置 跟 踪 的 Simulink 仿真 
被 控 对 急 为 : 










运行 模 岩 控 
Sinwulink 程序 chap3_5.mdl， 和 输入 取 


程序 chap3_3m， 





疼 卫 1D 模糊 探 制 的 位 置 契 朋 


仿真 程序 ，chap3_5-mdi， 如 疼 3-18 押 示 




















及 348 模 贿 控 制 的 Simulink 仿 忘 程序 
3.3 模糊 自 适应 整定 PID 控制 


33.1 模糊 自 适应 整定 PID 控制 原理 


在 上 生产 过 程 中 ， 许 多 被 或 干扰 因素 影响 ， 其 对 象 特性 参数 或 结 
改变 ， 自 适应 # 用 四 特征 参数 ， 实 时 改变 其 控制 策略 ， 

折 下 保持 怀 证 j 好 坏 取 决 于 关 识 模型 的 精确 度 ， 这 
大 量 采 用 的 仍然 是 PID 算法 ，PID 





对 象 随 着 负荷 变化 















的 调 幅 经 验 作为 





将 挑 作 


计算 机 中 , 根据 坝 场 实际 情况 , 计算 机 能 自动 调整 PTD 参数 ,这样 就 出 现 了 智能 PTID 控制 器 。 
这 种 控制 器 把 占 典 的 PID 控制 与 先进 的 专家 系统 机 结合 ， 实 现 系统 的 最 佳 控制 。 这 种 控制 必 
须 精 确 地 确定 对 象 模 型 ， 首 先 将 操作 人 员 《〔 专 家) 长 期 实践 积累 的 经 验 知识 用 控制 规划 模型 
化 ， 然 后 运用 推理 使 可 对 PID 参数 实现 最 佳 调整 ， 
由 于 操作 者 经 验 不 九 精 确 描述 ， 控 制 过 程 中 各 种 信号 量 及 评价 指标 不 易 定 量 表示 ， 模 网 
贡 论 是 解决 这 一 问题 的 有 效 途 称 , 所 以 人 们 运用 模糊 数学 的 基本 惠 论 和 方法 ,把 规则 的 条 件 、 
操作 用 模糊 集 表 示 ， 并 把 这 些 模糊 控制 规则 及 有 关 信 息 〈《 如 评价 指标 、 初 始 PID 参数 等 ) 作 
为 知识 存 入 计算 机 知识 库 中 ， 然 后 计算 机 根据 控制 系统 的 实际 响应 情况 〈 专 家 系统 的 输入 条 
:)， 运 用 模糊 推理 ， 即 可 自动 实现 对 PID 参数 的 最 佳 调整 ， 这 就 是 模糊 自 适 应 PID 控制 。 
目前 模糊 自 适 应 PID 控制 器 有 多 种 结构 形式 ， 但 其 工作 原理 基本 - 致 。 

自 适 应 模糊 PID 控制 器 以 误差 e 和 误差 变化 ec 作为 输入 ， 可 以 满足 不 加 时 刻 的 e 和 ec 
PID 参数 自 整 定 的 要 求 。 利 用 模糊 控制 规则 在 线 对 PID 参数 进行 修改 ， 便 构成 了 自 适应 模 
糊 PID 控制 器 ， 其 结构 如 图 3-19 所 示 。 


模 移 推理 
au | 本 
人 下 对 急 | 
虹 调节 器 
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疼 3-19 日 适应 模糊 控制 器 结构 


PID 参数 模糊 自 整定 是 找 出 PID 三 个 参数 与 e 和 ec 之 问 的 模糊 关系 , 在 运行 中 通过 不 断 
检测 e 和 ec, 根据 模 灶 控 制 原理 米 对 一 个 参数 进行 在 线 修改 ， 以 满足 不 同 e。 和 ec 时 对 控制 参 
数 的 不 同 要 求 ， 曾 使 被 控 对 象 有 良好 的 动 、 静 态 性 能 。 

从 系统 的 稳定 性 、 响 应 速度 、 超 调 基 和 稳 态 精度 等 各 方面 来 状 虑 ， 斑 , 尖 ,如 的 作用 如 下 ; 

(1) 比例 系数 已 的 作用 是 加 快 系统 的 响应 速度 ， 提 高 系统 的 调节 精度 。 名 越 大 ， 系 统 
的 响应 速度 越 快 ， 系 统 的 调节 精度 越 高 ， 但 易 产生 超 凋 ， 甚 全 会 导致 系统 不 稳定 。 台 取 值 过 
小 ， 则 会 降低 调节 精度 ， 使 响应 迷 度 缓 悍 ， 从 而 延长 调节 时间 ， 使 系统 表态、 动态 特性 变 坏 。 

(2) 积分 作用 系数 态 的 作用 是 消除 系统 的 稳 态 误差 。 丘 越 大 , 系统 的 静态 误差 消除 越 快 ， 
但 下 过 人 ,在 响应 过 程 的 初期 会 产后 积分 全 和 现象 ， 从 而 引起 响应 过 程 的 较 大 超 调 。 若 后 过 
小 ， 将 使 系统 毅 态 误差 难以 消除 ， 影 响 系 统 的 调节 精度 。 

(3) 微分 作用 系数 天 的 作用 是 改善 系统 的 动态 特性 ， 其 作用 凸 要 是 在 响应 过 程 中 抑制 
偏 闫 向 作 何 方向 的 变化 ， 对 偏 辩 变化 进行 提前 预报 。 但 如 过 大 ， 会 使 响应 过 程 提 前 制 动 ， 从 
而 延长 调节 时 间 ， 而 且 会 降低 系统 的 抗 于 扰 性 能 。 

PID 参数 的 整定 必须 考虑 到 在 不 同时 刻 三 个 参数 的 作用 及 相 蕊 之 问 的 关系 。 

在 线 实时 模糊 自 整 定 PID 控制 器 控制 方案 原理 如 图 3-4 所 示 。 

模糊 自 束 定 PID 是 在 PID 算法 的 基础 -上 ,通过 计算 当前 系统 误差 e 和 误差 变化 率 ee,， 利 
用 模糊 规则 进行 模糊 推 型， 查询 模糊 矩阵 表 进 行 参 数 调整 。 

模糊 控制 设计 的 核心 是 总 结 工程 设计 人 员 的 技术 知识 和 实际 操作 经 验 ， 建 立 合适 的 模 烤 
规则 友 ， 得 色 针 对 操 ， 矿 ， 必 二 个 参数 分 别 整定 的 模糊 控制 表 。 
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51) 加 的 模糊 规则 表 见 表 3-2。 


表 3-2 ” 称 的 模糊 规则 表 






















































































ee 
人 NB NM NS ZOQO PS EM PB 
e 
NB 了 PB PB PM PM PS ZD ZO 
NM PB PB PM PS PS ZD NS 
NS 了 PM 了 PM P?M PS ZO MS NS 
ZO 了 PM PM PS ZO NS NM NM 
PS PS PS ZO NS NS NM NM 
了 ML 了 PS ZO NS NM NM NM NB 
PB ZO ZOD NM NM NM NB NB 
(2) 大 的 模糊 规则 表 见 表 3-3。 
表 3-3 的 模糊 规则 表 
一 一 一 
四 
AAA NB NM NS 2ZD PS PM PB 
e 
NB NR NB NM NM NS ZO zZD 
NM NB NB NM NS NS ZO ZO 
NS NB NM NS NS ZO PS PS 
Z0O NM NM NS ZO 了 PS PM PM 
PS NM NS ZO PS PS 了 PM PB 
PM ZO ZO PS PS PM 了 PB PB 
PB ZO 2ZD PS PM PMA PB PB 
(3) 和 的 模糊 控制 规则 袁 见 诊 3-4。 
表 3-4 ”向 的 模糊 控制 规则 表 
xx 人 人 人 
ec 
ak 
NB NM NS ZO PS 了 ML PE 
。 
NB PS NS NB NB NB NM PS 
NM PS NS NB NM NM NS ZD 
NS ZO NS NM NM NS NS ZO 
ZO ZO NS NS NS NS NS ZO 
了 PS ZO 2ZO ZO ZO DOD ZO Z0 
了 M PB NS 了 S PS PS PS 了 也 
了 B 了 PB PM PM 了 PM PS PS PB 
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如 ， 大 ， 姑 的 模糊 控制 规则 表 建 立 好 后 ， 可 根据 如 下 方法 进行 所， 万 ， 和 恕 的 自 适应 校 





将 系统 误 美 e 和 误 美 变化 率 ec 变化 范围 定义 为 模糊 集 上 的 论 域 。 

eec = 人 -5-4-3-2-1.0.1.2.3.4.51 (3.10) 
其 模糊 子 集 为 eec = INB,NIMNS,O,PS,PM,PB} ， 子 集中 所 素 分 别 代 表 负 大 ， 负 中 ， 负 

小 ， 零 ， 正 小 ， 正 中 ， 正 大 。 设 eee 和 j 癌 ， 厂 ， 属 均 服 从 正 态 分 布 ， 因 此 可 得 出 各 模糊 子 


集 的 隶 届 度 , 根据 各 模糊 子 集 的 隶属 度 赋 值 表 和 各 参数 模糊 


















































































































































入 控制 模型 ， 应 用 模糊 合成 推理 设计 PID 参数 的 模糊 矩阵 表 ， 
查 出 修正 参数 代入 下 式 计 算 : 
皮 当 前 采样 伺 ， 
于 名 = 丰 +esec 由 k 
一 7 大 如 + 如 ,ec 《3.11) 
丰 二 各 + 人 :ec 让 
ec[ 提 = 维 ) 一 6 一 
2 在 线 运行 过 程 中 , 控制 系统 通过 对 模 帆 多 辑 规则 的 结果 
ee D=et 处 理 、 查 表 和 运算 ， 完 成 村 PID 参数 的 在 线 自 校正 。 其 工作 . 
了 流程 图 如 图 3-20 所 示 。 
etghecf 拉 ) 模 网 伴 
3.3.2 ”仿真 程序 及 分 析 
模糊 整定 skp ,AF .aa 
仿真 实例 
计算 当前 如 后 ,名 被 控 对 象 为 ; 
| 
ID 控制 加 输 岂 GD= 523500 
3+87.3532 +104703 
站 加 采样 时 间 为 hms ， 采 用 模糊 PID 控制 进行 阶 跃 响应 , 在 














第 300 个 采样 时 间 时 控制 器 输出 加 1.0 的 和 干扰， 相应 的 响应 


图 3-20 “在线 自 校正 工作 流程 图 
结果 如 图 3-21 一 图 3-26 所 示 。 





in,yout 








0 - - 一 ，， ， 
0 0.1 0.2 0.3 0.4 0.5 
timets) 


图 3-21 模糊 PID 控制 阶 跃 响应 
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02 timefs) 0Q3 D4 0D5 


图 3-22 ”模糊 PID 控制 误差 响应 








02 03 04 0 
timels) 


图 3-23 ”控制 器 输出 “ 








01 02 


timels) 03 


思 3-24 为 的 自 适应 调整 
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X 10” 





0.2 0.3 
timefs) 
图 3.25 天 的 自 适应 调整 











0 0.2 0.3 0.4 0.5 
timets》 

图 3.26 大 的 自 适应 调整 
仿真 程序 ，chap3_6.m。 
&Fuzzy Tunning BID Control 
Clear aILILz 
close all7 
=newfist'fuzzpid') 
a=addvar (ainput ，e'，[-3,3])7 &Parameter 所 
ac=addmfta,， input' ,1，'NB'，zmf'，[-3,-1]1): 
己 =aGdrmE (ainput' 1，NM' Erimt'，[-3，-2,0]) 7 
至 = 有 GdGmf (ainput' 1， NS' Erimf [-3，-1 ,1]) 7 
aa=aagmEta，'input' IT， 2 ，'trimf'。[-2，0.2])7 
ac=addmf (a,'input' 1, :PS'，tTimt'，[-11,3])7 
aaddmf (ta 'input' 1, PM'，'ErimE' [02,3])7 
ac=addmffta'input' ,1 'PB' smfE [1.3])7 
ac-addvar(a'input' eec' [-3,3])7 %Parameter ec 


aa=adQdmft (ainput' 2， NB'，zmt [3 1])7 
"120 


Ba=addmf (ainput ,2，NM'，trimf' -3 2,0]) 7 
已 =agdmf ta input' 2，NS' ErimE'，[-3，-1 1]) 
as=addmf (ar 'input' ,2，'Z'，'trimf'，[-2,0,2])7 
己 =aQdmf (aa 'input' ,2,，'PS' trimt'，[-1,1 ,3])7 
as=addmf (ar 'input' ,2,'PM' ,ttimt'，[0,2,3])7 
己 =addmf (aa input ' 2，'PB'，'SmE'， [13]) 7 


a=addvarfa,'output'，'kp'，[-0-3,0.3])7 %Parametet KDp 
ac=addmfta, 'output' ,1，'NB'，'zmf'，[-0.3， 0.11)7 

aa=addmf ta 'output' 1,'NM' EtrimE'，[-0.3,-0.2,0])7 

=addmf (a, 'ouLBuUE' 1， NS' trinmf' ，[-0.3, -0.1,0.1])7 
ac=addmf(a'output' ,1,'2'，'Erinmf'，[-0.2.0.0-2]); 


=aGdmf (av 'output' ,1,，'PS'，'Erimt'，[-0.1,0.1,0.3])7 
ac=addmf (av 'output' ,1，'PM'，'trimf' [0,0.2,0-3]) 
a=addmf (ay output' ,1，'PB' ermt' [0.1,0.3])7 


a=addvar (ay 'output'，'ki'，[-0.06,9.06]) $ParameteI Ki 
ac=adamtffa,'output' ,2，NB'，zmf' -0.06, -0.02])7 
a=adamf(a,'output' ,2，NM'，'Etrimf' ，[-0.06,-0.04,0])7 

ac=adcmft ta, 'output' ,2，NS'，trimnf' ，[-0.06,-0.02,0.02])17 
Ba=adernf ( 昌 , 'output' ,2，'Z"， trimf' [0.04,0,0.04]) 7 
ac=ademf(a,'output' ,2，'PS'，'Etrimf' ，[-0.02,0.02.0.061)7 
ac=adeamf{fa, 'output' ,2,'PM'，,'ttimt' [0,0.04,0.05]) 7 





a=ademf(a,'output' ,2,'PB'，'Ssrmf' [0.02,0.06]1)7 


aa=agdvar (aa,'outPuUE'，'kQ' -3，3]) 7 多 Patarmeter KG 
a=addmf ta, output' ,3,，'NB'，'zmf'，[-3，-1])7 
=addmf(a,'output' ,3，'NM'，'trimf'，[-3， -2.0])17 
ac=adamf{a,'output' ,3，'NS'，'ETimf'，[-3， -1 1])7 
ac=addmf(a,'output' ,3,'2Z'，'Ezrimt'，[-2,0.2])7 
ac=agdmfta,'output'，3,'PS'，'tzimt'，[-1-1,3]])7 
as=ademf{a,'output' ,3，'PM'，'trimf' [9 2，3]) 7 

中 =adqdrf fa,'output' ,3，'PB'， syE' [1,3])7 


rulelist=[1 1715117; 


PP hp Ph Ph Ph Pb 
本 
me ea 
ER 
mbpPp pw 
PP PP Ph b 
PP be 
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DNS NA 


wm 


um ua wm 让 ER 
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PP 


本 EN 


本 


Pb wuw war PR ww uao am wm ua mm wwe 


Pi mb mm un 


an 下 mn PP 


本 


让 人 ut ED ww eu PP wm 


mummnuaa 


P PP PP Pb P 


上 





让 


PP PP PP 


PPnb PP Pb 


了 7 了 32256115: 
了 了 4266117 
7526531; 
765617511; 
74141773137 


a=aaGruleta,rulcliet) 7 
aa=setfisfa,'DefbzzMethod'，'Centroia') 


writefisfa, "fuzzpia') 7 


忆 =readfisil'fuzzpia') 7 


革 PID Controller 

ts-0.0011 
sys=tft(5.235e005,[1,87.35,1.047e004,03)5 
aqsys=c2dfsys,ka,'btustin')i 
Itnum,aen]=cfdatatasys vi 


uai=0.0u_2=0.0iu_3=0.0; 





Y_L=0IYyY_2=0;:YyY_3= 


x=i0,0.0] 
error_ 1=D7 
e_1=0.07 
ec_]=0.07 
kp0O=0.407 
ka0=1.07 


ki0=0.07 


Ecor kk= 





5500 
七 ime (K) =K*tBB 


in(k)=1z 
sUsing fuz2zy inference to kunninG PID 
k_piq=evalfijst[e_ltvec_11,a); 
kp (KJ=kpO+k_pia(1) 7 
ki(k)=kiork pid(2) 
KkQtKk)=kdD+k_ bjidl(317 
tkK) =KP{K)*xt1)+kd (K)*x(2)+kitk)*Xx(3) 
.123 。 





IE k==300 $% aaqing disturbanceltl.0v at time 0.3s) 
QtK)=utk)+1.07 

end 

E utk)>=10 
ItK)=1L07 

EDQ 

if utk)<=-I0 
IIK)=-IO7 


emnd 


yout tk)=-dent2)xy_1-den(3)*y_2-Gen(4)*y_3rnumf1)xulk)+numf2)*u_1+ 
num(3) xu_2+numt4)xu 3 
erLOF{K) =Tinfk) -youttk) 7 
介 负 委 第 于 利和 于 负 秆 生生 机 ReEUID 口上 PID 让 a 工 me 上 e 工 S 相 时 务 和 和 和 生出 当先 种 洛 
U_3=u_27 
U_2=u_l7 
u_1L=uUCK) 


YY-_3=Y 一 27 
Y-_2=y-17 
Y_1=yceut{k) 7 


X(1)=error (K) 多 Calculating P 
XIP)=error (K) -errOT_17 名 Calculating D 


Xt3)=X(3)+erTOF (k] 多 Calculating 工 


e_1-xt1)7 


ec_1=x{2) 1 


error._2=error_ 17 
errOT_1=erIYot (K) 
ema 


Showrule la) 





figuret1L)7zplot (tirmerin，Pp' time yeuE rr ) 7 
Xlabelit'timets)')7ylabel('rinyout '): 
figure(2)7;p1obttime,ertor，T) 7 
xlabelt'timets)'):Ylabell'error ) 7 
figure(3) ;plotttimeru， rz) 
xlabelt'timets)')iylabelf ua')7 
figure(4)3:Plot (timeykP， 工 ) 
xlabeli'timets)')7Yylabel('kp') 
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figurelt5) ;plotittime,ki，cr')7 
xlabel('timelS) 1y1abpel( Xi) 
figurel5)7PLot (fime,kd rr ) > 
X1abelt'timefs) )rylabelt( ka') 7 
figurel7) ;Pilotmf{ta，' input' 1) 7 
figure(8) ;plotmfta，'input' ,2) 7 
figurel(9y ;plotmfta,'output'y1)7 
figuret10);pPLotmEf (aoutPut "2)7 
figure(tI1);plotmf(a，'output "3) 1 
plot fista) ; 

fuzzy fuzzpid 


通过 仿真 ， 还 可 以 得 到 以 下 几 个 结果 ; 
(1) 在 MATLAB 下 运行 plotmfta'input, D) 可 得 到 模糊 系统 第 一 个 输入 e 的 隶属 函数 ,， 同 
理 可 得 到 de ， 避 ， 为 ，Aa 的 隶属 函数 ， 如 网 3-27 一 图 3-31 所 示 。 























NM 卫 PS 





PM 


品 
& 8 
2 硬 


Degree of membership 
所 
中 





图 3-27 ”误差 的 隶属 函数 





但 NM PS 





图 3-28 ” 误 兰 变化 率 的 未 属 函 数 
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(2) 在 MAILAB 下 运行 plotfis(a) 可 观察 模糊 控制 系统 的 构成 ， 如 
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Degree of membership 


Degree of membership 


品 马 吕 
虽 吕 
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六 
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02 和 ooe 
| 
夺 的 素 属 函 数 


004 


国 3-30 


04 006 





NM NS  z PS 








也 -1 0 1 
kd 
图 3-31 各 的 求 属 函 数 














3-32 所 示 。 


RAR 
LA 关 头头 j 
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了 
( 关 关头 其 
人 


本 
(闪闪 并 关 】 
| 


人 幼 





ec (7) 
Systemfuzzpid': 2 inputs, 3 outpams, 49 
图 332 昼 逢 PID 控制 系统 构成 


(3) 在 MATLAB 下 运行 fnzzy fuzzpid.fis 可 进入 MATLAB 动态 仿真 工具 箱 动态 仿真 环 
境 ， 如 图 3-33 所 示 





图 3-33 模糊 PID 动态 仿真 环境 


(4) MATLAB 下 运行 showmuletaj， 可 得 到 以 下 49 条 模糊 规则 : 
TrleisNB)and (ecisNB) then (kpisPBjkiisNB)Ikd PS)O) 
IfeENB)andlecis NM) henfkpis PB)kiisNBNkd 二 NS) ID) 
IleksNB)andtecis NS)thenfkpisPM)kiisNMNKSNB)0D) 
LeisNB) and /ecisZ) hen (kpisPMIK NMNMkd 5NBI4) 

Jeis NB) and ec is PS) then (kpis PSMki SNS)kdisNB)0D 

lfieis NB) and ec is PR) then TIRp isZMKi 二 ZNMkdE NMIAT) 

IfieisNB)anaiecisPBiihenIkpisZMkiEZMkdssPS)ihD 

fieS NM and [ec 本 NB) then (kpisPBWkiisNBI PS) 

和 人 eisNM)and (ec 攻 NM)IhenikpisPBNkiENBNMkd 瑟 NS) 


芭 二 


p 


* 127。 


10. 
11， 
12. 


19. 


四 


已 
品 


四 


这 


开 
总 


44. 


46. 
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If(eis NMD and (ec is NS) then (ktpisPMJkiis NM)(kdis NB) (1 
Iteis NM) and (ec is Z) then (kp is PSXkiis NSXkdis NMD (D) 
Ifeis NMD and (ec is PS) then (kp is PS)ki is NS)(kd is NM) (D 


.I(eis NMD) and (ec is PM) then (kp is ZJki is Z)Gkdis NS (D) 
.IT(eis NM) and (ecjijs PB)then (kpisNS)Ckiis Z)kd is Z) (0D) 
.HeisNS) and (ecis NB) then (kpis PMIUG is NB)(kdis Z) 0) 

. 开 (eisNS) and (ec is NM) hen (kp is PM)(kiis NM)(kd is NS) (]) 
.HeisNS) anatkecis NS) then (kp is PMGkiis NS)kdis NM) 1) 
.IT 人 eisNS) and (ecis Z) then (kp is PSJ(ki is NS)Xkd is NM) () 


If(eijisNS) and (ecis PS) then (kp is Z)(Gkiis ZXkd is NS) (1 


ffeisNS) and (ecisPM) then (kpis NSJGiis PSXkd is NS) (1) 
.HeisNS)and (ecisPB)then (kpis NS)GkiisPS)tkdisZ)(0D) 
.Heis Zy and (ecigNB) then (kp is PMJGxiis NM)(kdis 忆 (1 
.If teisZ) and (ecis NM) then (ktpis PM)Xkiis NM(kdis NS) (CD 
.EteisZ) and (ecisNS) then (kpisPS)(kiis NS)kdisNS) CD 
.teiZ) and (ecis 刀 then (ktpisZjkiisZJkdisNS)(D 
Eeeis ZJ and (ecis PS)then (kpiNS)kiisPS)keisNS) CD) 
.HeisZ)and (ecis PM) then (kp isNM)(kiisPM)(edisNS) 0) 
.HeisZ)and (ecisPB) then tkpis NMGkiisPM)disZ(0D 
,IE(eis PS) and kecisNB) then (pis PS)di isNM)(kdisZ)(D) 
,If(eiPS) and (ec is NM) then (kpis PS)(kiis NSXkd is Z) (1) 
.LE(eisPS)and (ecisNS)then(kpis Z)kiisZ)tkdisZ)D 
.feis PS) and (ecisZ) then (kp is NS)(kiis PS)(kdis2 (1) 
.Heis PS) and (ecis PS) then (kpis NS)(ki is PS)kd is Z) (TD) 
.Eteis PS) and (ec is PM) then (ktp is NM)(kiis PMXkdisZ)(G) 
.feisPS) and (ecis PB) then (kp is NM)GkiisPBJkdis 瑟 (D 
.If(eis PM) and (ecjis NB) then (kxp is PS)Gki is 妃 GkdisPB) (1) 
.HE(eisPM) and (ec is NM) then (kp 下 (ki is Z)Gkd is PS) ( 
.Eteis PM) and (ecis NS) then (kgp is NSJkiis PS)(kdis PS) (1) 
.Teis PM) and (ecis Z) then (kp is NMD(Gkiis PS)(kdisPS) 0) 


If(eisPM) and (ec is PS) then (kpis NM)(ki is PMD)(kd is PS) (Cl) 


.feis PM) and (ec is PM) then (kp is NMDkiis PB)(kd is PS){lD) 
.下 feisPM) and (ec is PB) then (kp is NB)kiis PB)(kdis PB) (1) 
,下 (eis PB) and (ecis NB) then (kp is Z)(kiis ZXkd is PB) (TD) 


于 (eisPB) and (ec is NMD then (kp is D(ki is Zi(kd is PM) 1D 


,IffeisPB) and (ecis NS) then (kp is NM)(ki is PS)(kd is PMD (TD) 


下 (ceisPB) and (ecisZ) then (kp is NM)Gki is PM)kd is PM) (CD 


.If(eis PB)] and (ec is PS) then (kp is NMJKi is PMD(kd is PS) (CD 





48.1f (e is PB) and (ec js PM) then (kp is NB)(ki is PB)(kd is PS) (1》 
49.IfteisPB) and (ec is PB) then (kpis NB)(Gki is PB)(kd is PB) (1) 


3.4 ”模糊 免疫 PID 控制 算法 
3.4.1 模糊 免疫 PID 控制 算法 原理 


常规 增 量 式 PID 控制 器 离散 形式 如 下 : 
(有 一 MK 一 JJ) 十 各 (e( 了 一 e(K 一 D) 十 右 e( 拉 二 下 (e( 让 一 2e( 天 一 


=xk~D+bde(O-ek-D) + 人 + 息 (elD -2 人 -D+eKk 一 2 
9 





式 中 ， 帮 , 帮 尖 分 别 为 比例 、 积 分 和 微分 系数 。 
了 控制 器 的 控制 算法 为 : 
MKN = 有 pe( 
免疫 PID 久 制 器 是 借鉴 生物 系统 的 免疫 机 理 而 设计 出 的 一 种 习 
体 的 -种 特性 生理 反应 。 生 物 的 免疫 系统 对 于 外 来 侵犯 的 抗原 ， 可 


D+ek-2)) 
(3.12) 


《3.13) 


线性 控制 器 。 免 疫 是 生物 
[产生 相应 的 抗体 来 抵御 。 


抗原 和 抗体 结合 后 ， 会 产生 一 系列 的 反应 ， 通 过 吞噬 作用 或 产生 特殊 酶 的 作用 而 毁坏 抗原 。 
生物 的 免疫 系统 由 淋巴 细胞 和 抗体 分 子 组 成 ， 淋 巴 细胞 又 由 胸腺 产生 的 工 细 胞 《分 别 为 辅助 


细胞 Ta 和 抑制 细胞 Ts ) 和 骨髓 产 生 的 B 细胞 组 成 。 当 抗原 侵入 机 





体 并 经 周围 细胞 消化 后 ， 








将 信息 传递 给 工 细胞 ， 即 传递 给 T 细胞 和 Ts 细胞 ， 然 后 刺激 B 细胞 。B 细胞 产生 抗体 以 消 


除 抗原 。 当 抗原 较 多 时 ， 机 体内 的 Tt 细胞 也 较 多 ， 而 Ts 细胞 却 较 





少 ， 从 而 会 产生 较 多 的 B 








细胞 。 随 着 抗原 的 减少 ， 体 内 到 细胞 增 多 ， 它 抑制 了 Ta 细胞 的 产生 ， 则 B 细胞 也 随 着 减少 。 
经 过 一 段 时 间 间 隔 后 ， 免 疫 反馈 系统 便 趋 于 平衡 。 抑 制 机 理 和 主 反馈 机 理 之 问 的 相互 协作 ， 


是 通过 免疫 反馈 机 理 对 抗原 的 快速 反应 和 稳定 免疫 系统 完成 的 。 





免疫 系统 虽然 十 分 复杂 ， 但 其 抵御 抗原 的 自 适 应 能 力 却 是 十 分 明显 的 。 生 物 信息 系统 的 


这 些 智能 行为 , 为 科学 和 工程 领域 提供 了 各 种 理论 参考 和 技术 方法 


。 基 于 上 述 免疫 反馈 原理 ， 


提出 了 免疫 PID 控制 器 : 假设 第 天 代 的 抗原 数量 为 E(6 ， 由 抗原 刺激 的 Ts 细胞 的 输出 为 





和 (9， 字 细胞 对 也 细胞 的 影响 为 中 (0 ， 则 B 细胞 接收 的 总 刺激 
SG =T6( 昌 -下 扣 
式 中 ， 人 而 ( 拉 = 大 EC 和 (=KACSGED)ASUD)ECC) 。 


AS(D=Au(k) 。 有 如 下 的 反馈 控制 规律 ; 





一 个 选 定 的 非 线性 函数 ， /0 表示 细胞 抑制 刺激 能 力 的 大 小 。 


《3.14) 


若 以 抗原 的 数量 sto 作为 偏 盖 e(e) ，B 细胞 接收 的 总 刺激 Se) 作为 控制 输入 xD ， 则 


MD=KQ-WfC(bAx(D)e(O= ae(D (3.15) 
式 中 ， 和 = KG- 矿 (xD,AxD))， 天 = 石 为 控制 反应 速度 ， 刀 -人 为 控制 稳定 效果 ， 太 为 


利用 模 精 规 则 可 逼近 非 线性 函数 F() : 每 个 输入 变量 被 两 个 模糊 集 模糊 化 ， 分 别 是 “ 正 ” 


(P) 和 “ 负 ”(N);， 输出 变量 被 三 个 模糊 集 模糊 化 ， 分 别 是 “ 正 ” 





(P)、 零 “Z” 和 负 〈N)。 
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以 上 素 属 度 函 数 痢 定义 在 整个 {-,+ee) 区 间 。 接 “细胞 接受 的 刺激 越 人 ， 则 抑制 能 力 越 小 ” 
及 “细胞 接受 的 刺激 越 小 ， 则 抑制 能 力 起 上 ”的 原则 ， 可 采用 以 下 四 条 模糊 规则 : 
(1) IfuisPandAnisPthenfu AuisN (1 
(2) HuigPandAuisNthenfau、AuisZ (1) 
(3) IfuikgNandAuisPthenfu AuisZ 51) 
《4) IuigNandAuisNthenfu AisP (1> 
在 各 规则 路， 使 用 Zadeh 的 模糊 轴 得 AND 操作 ， 并 采用 “centreid” 反 模糊 化 方法 得 到 
模糊 控制 器 的 输出 广 0) 。 
基于 免疫 反馈 原理 的 控制 器 实际 上 就 是 一 个 非 线性 P 控制 器 ， 其 比例 系数 
和 = 天 G- 二 (DAKt)) 随 控制 器 输出 的 变化 而 变化 ， 其 中 天 为 增益 ， 则 免疫 PID 控制 占 
的 输出 为 
(有 =aE-D ttetO -e+ 和 ci + 乱 (e(D-2c( -D+ek-2)) 
了 P 《3.16) 
一 以 天 一 ]) 十 TICe( 大 一 (天 一 D)+ 天 'e( 太 + Ke( 拉 一 2e 估 一 DJ 二 e( 天 一 2 





3.4.2 仿真 程序 及 分 析 


仿真 实例 
设 被 探 对象 为 … 个 延迟 系统 : 

1 sm 
60s+1 

采样 时 间 为 20s， 采 用 免疫 PID 控制 器 式 〈3.16)， 取 天 =030，1T=080， 

大 二 0.30, 如 =030 。 输 入 的 指令 信号 为 10sgnGsin(3rt) ， 仿 走时 间 为 1000 个 采样 点 ， 为 了 
测试 控制 器 的 鲁 棒 性 ， 在 第 500 个 采样 时 间 时 加 入 -一 个 于 扰 ， 免 秽 FID 控制 方 波 跟踪 结果 
如 图 3-34 和 图 3-35 所 示 。 仿 真 结果 表明 ， 免 疫 PID 控制 具有 很 好 的 控制 效果 和 较 高 的 鲁 
棒 性 。 非 线性 函数 广 ) 为 模 灶 控 制 的 输出 ， 模 糊 控 制 输入 、 输出 隶属 函数 如 加 3-36 一 图 3-38 
所 示 。 





GCC)= 














1 
1 





0.5 
车 1 
六 0 1 
皇 | 
-0.5- ; 
0 1 和 1 
9 0 timets) 本 

x 10 


图 3-34 ”免疫 PTD 控制 方 波 椒 踪 
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图 3-35 ”免疫 PID 控制 如 的 释 化 





Degree of membership 








-10 -5 9 5 10 
图 3-36 ”免疫 PJD 控制 & 隶属 函数 
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0 
红 
图 3-37 ”免疫 PID 控制 tu 隶属 艺 数 
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图 3-38 ”免疫 PITD 控制 /(] 隶属 函数 
仿真 程序 : chap3_7.m。 


%FuzzYy Immune PID Control 
Clear al11; 


close al17 
aa=mnewftist'fazz_1jk') 1 
EL=10， 


as=adavar (ainpur'，'u'vE-ELx1, EL1x*1])> 和 Parameter 所 


a=addmf (aa input' 1， NB'，'zmEt'，[-EL*1 ,1x13) 7 


Ba=aaGdmf ( 己 ，input' Tt， PB'，'SIE' [一 EL*+, 寺 1*1]) 

f2=1 .07 

a=adGdvar (ainput' du'"，[-f2*l,f2*1])17 多 Parametet ec 
=aQGmf (einput' 2，NB'， 2Zmf'，[-E2*] ,f2x1]) 17 

Ba=aGdmf (ainput' ,2 PB'，'SmEf'，[-f2x*1,f2x 了 ]) 7 

E3=1.07 

ac=addvar (ay output'，'E"，[-E3x*1, 夺 3*l]) 旬 Parametet 世 


a=addmft (aa， output' 1， NB'，'zmf'，[-f3*1,0]37 
a=adldmf ta 'output' 1， 2 LTimE' [ES3x10vf3x1]) 7 
a=addmf (Ba, output ' ,1,，'BB'，'Smf'，[0,f3r1])7 


TUlelist=[2 2 1 17 & EQGit rule base 
2412117 
132117 
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11311*]7 


as=adqdrulela,rulelist) 7 


台 ShOwIUIG (aa 多 Show fuzzy rule base 


aL=Settis(a,'DetuzzMethod'，'centroiQ' ) 
WwWFiEeftistal， ljk') 刍 Save trO fuzzy file "1jJk,fis” which can be 


sg simulakeqd with fuzzy ool 


Ba2=IeaGfis('1jk')y 
SPlotfie(a2) 


筷 旬 种 逢 笛 旬 向 机 第 苇 向 省 省 和 名 生 多 时 USTLnG 了 FUZZY COnEIOLTeI 角 向 相 革 省 计 多 客 因 当下 省 竺 入 儿 条 儿 


ts=20; 
Sys=rft[1],160,1]，'inpurdelay' ,80) 7 
asys=c2Glsysts，zoh') 1 


[num, den]=tfdataltqsvs，' vi 


u_l1=0iu_2=0:u_3=0ru_4=Diu_5=05 
Y_1=0) 

e_1=0je_2=0) 

for k=1:1:1000 


上 time tk)=kx*Es7 


rin(k)=1.0*signfsinft3wPpixkr0-001T)) 7 


S$sLinear moqel 


yout {k)=-aen12)*y_1+numt2)*u 57 


et(K)=rin fk)-Youctk) 
ectkj=el(k)-e_l; 


f(k)=evalfis([u_l ul-u 2],a2)7 


K=0O.3017 


xice=0.80); 
KP(Xj =Kw (于 -XiterE(k)) 17 


utk)=u_1L+KP(k)xttelkl-e 1)r0.3xetk)+0.3*te(k)-2*e 1I+e_2))1 
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E k=-=500 
UK)=utk)+IL.G7 


ea 


$Return Of Parameters 


D_5=u 47D_4=uU 3:u_3=u_2;U_2=a_liu_L=u(K) 





figuret2) 1 





PEot (time,Trjiny pb' ,time yout rr ) 
xlabelt imets) jiyYlabel( Tin yout' 0) 
figure12) 

瑟 Let (Limey er 1 

xlabelt'timets) ylabelt'error' ) 1 
Eigurel31 

DPlot (kime, Du， ) 7 

Xlabpelt'timetSy' 7yIabelIf ai 
figuret4) 

BlLot {time,Kp， 1 

Xlapelt'timels) yl1abeil( RD ) 
Figuret5) 

Plorrt (ainput' yl)y 

figure(6} 7 

Plotmf (tar input' 2)1 

figuret7) 7 


PLIotmE ta output'y 1) 


3.5 基于 Sugeno 的 模糊 控制 


3.5.1 Sugeno 模糊 模型 


传统 的 模糊 系统 为 Mamdani 模糊 模型 ， 输 出 为 模糊 量 。 
Sugeno 模糊 模型 的 输出 隶属 函数 为 constant 或 inear， 其 函数 形式 为 : 
?=Q 


4 《3.17) 
了 一 QY 


它 与 Mamdani 模型 的 区 别 在 于 ; 
(1) 输出 变量 为 常量 或 线性 丽 数 ; 
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〈2) 输出 为 精确 基 。 


Sugeno 型 的 模糊 排 理 系统 非常 适合 于 分 段 线性 控制 系统 ， 例 如 在 导 阐 、 飞 行 器 的 控 
制 中 ， 可 根据 高 度 和 速度 《马赫 数 ) 建立 Sugeno 型 的 模糊 推理 系统 ， 实 现 性 能 良好 的 线 


性 控制 。 


3.5.2 ”Sugeno 模糊 模型 的 建立 


设 输 入 Xe[053 ，7e[0410] ， 将 它们 模糊 化 为 两 个 模糊 量 : 小 ， 大 。 输 出 Z 为 输入 Ce 


的 线性 函数 ， 模 糊 规 则 为 : 
对 X 为 small and 下 为 small then 乙 = -X+y-3 
于 X 为 small andY 为 big thenZ=X+y+l 
玉 X 为 big andY 为 small then Z=-2 十 2 
开 X 为 big and Y 为 big thenZ=2x+y-6 
仿真 程序 见 chap3_8.m。 模 糊 推理 系统 的 输入 隶属 函数 曲线 及 输入 /输出 曲线 如 
图 3-40 所 示 。 
道 过 命令 showmle(ts2) 可 显示 模糊 控制 规则 ， 共 以 人 4 条 : 


于 (XissmalD andfY is small) tnen tZ is first areay (1 
IfOXissmalD) and(Y is big) then (Z is second areal (]) 
If COXis big) and (Y is small) then (Z is third area) [1) 
IE(Xisbig)and(Yis big)then (Zis fourth area)(1) 





ion 
吕 
名 一 


input functk 
品 
人 

















加 
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各 
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图 3-39 Sugeno 模糊 推理 系统 的 箱 入 隶 届 两 数 曲线 








3-39 和 
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ype 





ts2=adgvari1t 


ks?z=addmf cs2 





addavsarita 





5s2=adamftits 


tsa-addamt(ta2， 


tsS2saddmf It 
2=adamf 


addmgf 





=addamf (52， 

















1 
1 1 


于 


图 3-40 


chap3_8m- 


mode 














0 0 


Sugeno 伞 烽 准 再 系统 的 移入 /输出 上 曲线 














tct1le ! ]} 
big' gasasm 1.8 5] 
011 

big 4 10j) 
3 | 
Ex 寺 1 
aecdna aroari'I 1 
bhicd aree ear 

CH area ineaz' ,lz 1 











上 ts2=aqQqruletts2,ruleliist) 


Showrulet(ts2) 





Ulist=zerost11,21)7 


Eor 1=1:1:6 





ectj) = 了 -TI 
Ulistti,j)=evalfis([eti)vectJ)],bs2) 1 
enQ 
end 


Ulist=ceil(Ulist) 


Eiguref1j7 

Sbbploc 2117 

Blotmft tts2 ， input' 1) 1 
xlabel('x'j,ylabel('input function') 17 
Subplot 212; 

Iotmt (ts2，inPut' 2) 7 

xlabeI('xX') ,ylabel('input functiorm ) 


于 i9uTef2) 7 
gensurE(tS2) 
xlabel('x'j,ylabelt'y') zlabel('Z')7 


3.5.3 基于 Sugeno 的 个 立 摆 模 糊 控 制 





倒立 摆 的 动力 学 方程 为 : 
忆 二 加 
守 = gsin( zi) 一 antpxzsin(2x)712 一 Gcos( 为) 到 《3.18) 


“ 4731 一 al cos 


式 中 ， 闷 表示 摆 与 垂直 线 的 夹 角 ，z =6 ， 思 表示 皖 的 旋转 角速度 ，z = 人 ，8=9.8mfs 为 
力 加 速度 ，mm 为 倒立 摆 的 质量 ，21 为 摆 长 ，a= Im+M) ， 嵌 为 小 车 质量 。 
如 果 摆 角 很 小 ， 则 倒立 摆 的 动力 学 方程 可 简化 为 : 
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三 二 如 
Sr apx3an -0 (3.19) 
4737 一 Go 
取 便 立 摆 参数 诊 =2kg ，jM = 号 g，!1=05m ， 在 (0,) 平 而 上 对 倒立 皖 动 力学 方程 进行 
模 站 分 割 ， 实 现 倒立 摆 模型 的 局 部 线性 化 。 


倒立 摆 角 度 范围 为 [-15,+15] 度 , 即 [-15+15]x180 扳 度 ， 角速度 范围 为 一 200,+200] 度 / 秒 ， 


2 一 


即 [-200.+200] xT 弧度 / 秒 。 它 们 的 束 属 函数 如 图 3-41 和 网 3-42 所 示 。 





Degree of membership 











可 1 
-0.25 -02 -045 -0.1 005 0 005 01 015 02 025 
theta 


图 3-41 角度 9 弧度) 的 隶属 度 曲线 








姑 ZR 


Degree of membership 
吕 D 口 
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吕 
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四 -2 -| 0 1 2 3 
omega 


图 3-42 角速度 6 〈 弧 度 / 秒 ) 的 束 属 度 曲线 
sx- 人] ， 可 得 到 5 个 线性 化 方程， 表示 为 以 下 7 条 Sugeno 型 模糊 规则 
2 
Ri 芝 x 为 ZR and xs* 为 ZR then 文 = 和 以 二 Biu 
R2: If x) 为 ZR and x) 为 NG 或 PO then 六 = Aax+Bau 
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R3， 开 x 为 NG 或 PO and x:; 为 ZR then 文 = 入 尽 +B3u 
R4:， IT x 为 PO and x: 为 PO then 文 = Asx 二 了 su 
R5: 开 xx 为 NG and x? 为 NG then 文 = 全 sx+B4u 
R6: 开 xl 为 PO and x) 为 NG then 六 = Asx+ 旦 su 
RI7: 1 x 为 NG and x; 为 PO then 广 = AsX+Bsn 


对 R1， 当 辣 和 2 都 为 ZR 时 ， 倒 立 摆 的 动力 学 方程 为 : 
8 二 
4731 一 an 


对 有 2， 当 辣 为 ZR， 2 因为 NG 或 PO 时 ， 总 =4200xjg， 倒立 摆 的 动力 学 方程 为 : 


2 《3.20) 


Xi 一 Gd XI 一 CU 
4731 一 apt 


对 R3， 当 为 为 NG 或 PO， 六 为 ZR 时 ， 三 =+15x160 ， 倒立 摆 的 动力 学 方程 为 : 


《3.217? 


3 一 


让 0 一 qcos( 地 习 闻 (3.22) 
4737 一 Gd cos (XI 


对 了 4， 当 因为 PD， 加 为 Po 时 ， 和 =15xTE ， 如 =200xT0， 倒立 摆 的 动力 学 方程 





本 一 Qir sin(2x1)A2Xxa 一 GOsC) (3.23) 
一 4731 一 an cos 2() 


对 R5， 当 矶 为 NG，x 为 NG 时 ， =-15xT0 ， 入 =-200xT55 ， 倒立 择 的 动力 学 


方程 同 式 〈3.23)。 





对 R6， 当 大 为 PD， 郊 为 NG 时 ， 冯 =15xj65 ， =-200x65， 倒立 摆 的 动力 学 方 


8 -GE asSin(22)12XXa 一 4COSCX JU (3.24? 
4731 一 azal cos“() 


对 R7， 当 交 为 NG， 六 为 PO 时 ， =-15x180 ， 总 =200x165， 倒立 择 的 动力 学 方 





一 





程 同 式 〈3.24)。 





将 个 立 搜 实际 参数 值 及 、 分 别 带 入 式 3.20) 一 式 (3.24)， 得 ; 
0 [fo ao 1 
“|。 .8919 0 生 =[14.9039 0 15.806 0 


机 0 1 0 1 
4 一 |15.806 -0.0704 | ” 115.806 0.0704 


已 =| 0 -| 6 =| 0 ] 
1 一 | -00811| | -oo811 ”|[-00779 
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0 0 
旦 4 = ， 三 
4 0.0779 | 8 0.0779 ] 


选择 期 望 的 闭环 极点 (-10+10iD) ， 采 用 &=-Ex 的 反馈 控制 ， 利 用 极点 配置 函数 
place(A,B.P)， 可 分 别 得 到 5 个 线性 化 方程 的 反馈 增益 短 阵 五: 

六 =[ 2662.7 - 246.7]， 丙 = 上 2650.5 - 246.7]， 机 =[ 2770.5 - 256.8] 

书 =[2770.5 -2559]， 瑟 =[2770.5 -257.7] 

根据 倒立 择 的 模糊 建 模 过 程 ， 可 以 设计 PD 型 模糊 控制 器 ， 其 模糊 规则 为 : 


开 x 为 ZR and x:? 为 ZR then u= Fix 

玉 xi 为 7R and x: 为 NG 或 PO then u= Fox 
If x 为 NG 或 PO and x; 为 ZR then u= Fix 
开 x 为 PO and xz 为 PO then u= Fix 

If x 为 NG and x; 为 NG then u= Fix 

开 xi) 为 PO and x:; 为 NG then uU= Fix 

开 x 为 NG and x: 为 PO then 口 = 六 x 


通过 命令 showrulettc) 可 显示 模糊 控制 器 “tc.fis” 的 模糊 筑 则 ， 共 8 条 ; 


1.E(thetais NG) and (omegais NG) hen (ti No.4) 0) 
2. 达 (thetais NG) and (omegais ZR) then (uiNo.3) 
3.IEtthetais NG) and (omega is PO) then Qis No.5)() 
4. 开 (thetaisZR) and (omegais NG) then uisNo.2) (TD 
5.If (hetais ZR) and (omegais ZR) then (uis No.D 
6. 和 (thetais PO) and (omegais NG) then (uis No.5)(D) 
T,If(theta is PO) and (omegais ZR) then (uis No.3) (1 
8.I(thetais PO) and (omegais PO) then (uisNo.4) (1) 


通过 命令 showruletmodeD) 可 显示 模糊 控制 器 “tc.fis” 的 模糊 规则 ， 共 9 条 ; 
1.If(thetais NG) and (omegais NG) then (4_theta is No.4)d_omega is No.4) 《1) 
2. If (thetais NG) and (omegaisZR)] then (d_theta js No-3)Xd_omega is No.3) (1) 
3.[f(theta is NG) and (omega is PO) then (d_theta is No.5)(d_omega is No.S) (]) 
4. Ifttheta is ZR) and (omega is NG) then (d_theta is No.2)(d_omega is No.2) (1) 
.Thetais ZR) and (omega is ZR) then (d_theta is No.D)(d_omega is No.1) () 
6.If (thetais ZR) and (omega is PO) hen (d_thetais No.2)(d_omega is No.2) (1) 
?If(theta is PO) and (omega is NG) then (d_theta is No-5)d_omega 认 No.S) (1D) 
8.If (thetais PO) and (omega is ZR) then (d_theta is No.3)(d_omegais No.3){1) 
9. If (theta is PO) and (omega is PO) then (d_theta is No.4)(d_omega is No.4) (1) 
倒立 摆 的 初始 状态 为 《0.20，0)。 仿 起 程序 由 倒立 摆 线性 化 程序 chap3_9fm 和 控制 程序 
chap3_9.m 两 部 分 组 成 在 以 制程 序 中 ,分 别 实现 了 用 于 倒立 摆 建 模 的 TS 模糊 系统 “modelfis” 
及 用 于 控制 的 TS 型 模糊 控制 器 “tc.fis”。 倒 立 摆 的 摆 角 、 角 速度 及 控制 回答 出 的 仿真 结果 如 
图 3-43 和 图 3-44 所 示 。 
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只 ngle rate 

















-2 4 
0 02 04 06 08 1 12 14 16 18 2 
timets) 
图 3-43 ” 摆 表 的 状态 响应 
各 
号 
吉 
得 
四 
上 
和 














timets) 


图 3-44 ”控制 器 的 输出 


线性 化 程序 :chap3_94f.m。 


g%Local linearization for single inverted Pengu1um 
clear all: 


close all11; 


9=9.8， 


=21 





]1=0.57 
站 =1Y (THM) 


天 浊 各 于 沁 和 于 画 甸 和 和 先 和 名 委 和 于 和 客 务 各 先生 于 备 千 入 先 各 和 备 和 和 和 
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多 BEGUation 1: 
已 1-G/A (473y1- 忆 Is]) 
al=[L0O 17 

al 0] 


bl=-a/ta/3x1-axmx1)1 
BL=[0;bll] 
第 秆 牛 先 币 条 向 洛 省 名 竺 全 生生 各 千 千 钊 葛 先 邯 先 负 儿 锡 负 各 狗 洛 和 萝 务 千 备 生生 
8EGuation 2: 
X2=200*Pi71807 
a2= (g-awmxlxx2^2) /1(4/3*1-axms1) 1 
R2=10 1) 

aa 01 


b2=bl: 

B2=[0;b21] 

条 入 锡 和 名 久 各 移 条 务 乞 务 守 多 各 竺 务 村 千 各 各 省 秆 范 千 竺 千 针 省 告知 已 入 省 移 
Equation 31 

虽 X1=-15x*pi71807 

X]1=154pi718037 


a3=g/(4/3x1-axmrly(cos(xl))^2) 
3=[0 1 

a3 0] 
b3=-axcos(xl)/(4/3*1-axmr1x*tcos (X1))^2) 
B3=[0;b3] 
利和 中旬 和 利和 于 第 各 和 先生 和 先生 和 和 第 和 先例 和 利和 对 和 浊 和 货 第 和 
%EGuation 4: 
xl=15*pi/1807 
x2=200*pi/180; 


a41=g/t473*1-axmxlx(cos(x1))^2》 
ad42=-arImx*1xX2xsinf2xxl)*D.5/14/3x1-aymxrlrtcosfx1)) “2) 
Rd=[0 1 工 : 
a41 ad21 
b4=b31 
B4= [0:b4] 
生 守 和 第 和 允 和 和 千 生 贡生 和 和 秀和 和 各 委 守 务 和 和 和 生机 和 和 和 各 人 和 和 和 
#Ecuation 51 
x3=-15w*pPi/7180: 
x2=200xpi/180; 
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7 1473% 工 一 忆 rm]x(CoSs(XL》) 2) 
aa52=-armx1x*x2*Sin(2xx1)*0.5/(473*1-axrmxlwtcoafx1))^2) 
R5=[0 17 ， 








a51 a52] 
DP5-=b3; 
B5=[0;b5] 
控制 主 程序 ，chap3_9.m。 
SSugeno type fuzzy control for single inverteqd pendulum 
CSlose alL1l7 
P=[-10-101*-10+101]7 &Stable pole point 


F1=place(RL,B1，G) 
F2=place(Ra2,B2,P) 
F3=place(R3,B3，P} 
F4=Dplace(R4,B4,E) 
F5=Place(aA5,B5,P) 


全 允 利 罗 委 和 多 竺 名 名 洁 宣 条 名 和 和 务 币 省 千 各 和 针尖 委 千 秀和 和 和 生 秆 千 千 和 机 下 和 攻守 另 攻 殉 天安 甸 
tc=newfis('tc ysugeno')y 
tc=addvar(tc，'input'，'theta',[-15,15]*piz180)7 
tc=addmf{ftc, 'input' 1 NG gaussmf' [5,-15jxpi/180)》 
tc=addmfttc，'input' ,1,'ZR' gaussmi'，[5,0]*pi/180)， 
tc=addmf(ttc，'input' 1,，'PO' gaussmf' [5,15]x*pi7180) 7 


tc=aadvarftc，'input' omega',[-200,2001*piz180) 7 
tc=addmfttc，'input' ,2，'NG'，'gaussmf'，[50, -200]*pi/180) 1 
tc=addmf [tc，'input' ,2，'ZR' gausgsmE' [50,0]*pi/180) 
tc=addmf (tc，'input' 2, 'PD' gausemE' [50,200]wpi7180)7 


tc=adqvar tc，'outPput'，'ua'，[-300,0])7 

tc=addmfE ftc, output' 1，'NO-1'，1inear'， [FT(L)，EF1(2)]) 
上 CC=addmf (tc output ' No.2'，'1inear'，[F2(1)，F2(2)]) 7 
上 tc=aacrnt (tc output' 1， No-3，1inear' yiF3(LI)，F342)]) 1 
tc=addqmf(ttc，'output', 1， No.4'，'1inear'，[F4(1) Pdt2)]) 7 
tc=aqdmf(ttc，'output' ,1,，'No.5' ,1inear'，[F5(t1)，F5(2)])7 


Fuilelist=[LIL 1 4 11; 
12311; 
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1 35115 
21211; 
221117” 
31511; 
323117 
33411]7 
tc=adqruleltc,Irulelist) 


秆 钉 负 务 华 名 入 省 和 省 多 争 徊 下 咎 咎 攻 甸 谢 千 下 机务 洁 澳 于 于 入 对 币 澳 省 省 沉 东 东 车 守备 甸 务 千 备 乱 务 竺 下 
moedaelL=newfis('moael'，'suSenc') 1; 

modael=adqvar (model，input',，'theta',，[-15,15]*xpi/180) 
mode1=addmf (Imode1l，'input ' ,1，'NG'，'gaussmt' ,ES 一 15]xpiy18017 
modqel=addmf (mode1，'input' ,1，'ZR'，gaussmf' ,15,0]*pi7z180D0) 1? 
modeI=addmf (mode1，'input' 1 PD'，'gSaugsmf',[S,15jxpi/L80)7 


modqe1=aqdvartmoedel，'input'，'omega',[-200,200]*Pi7180) 7 
modqe]l=addmf (mode1，'inpur' ,2，'NG'，'gaussmf' ,150, -2001*pi7180) 7 
model-addmf (model,，'input' ,2，'2R'，'9atssmf' [50,0]*pi/180) 7 
modeI=addmf tmode1l，'input' 2,，'PO:，'gaussmf'， [50,200]*pi7180) 7 


model=addvartmodel，'input'，u'，[-5,5])7 


mode]1=adadmf (tmode1，'input' ,3，RnY' ，gaussmf'，[1.5,，-5])7 


model=addvar (model，'outpuat'，'d_theta'，[-200,200]*piv180) 7 
linear' [OO 100)7 
Tinear'y ID 19 01)5 





mode1=aqdmf (ImeoGel，'output' ,1，No-1 





moael1=addmf (Imodel，'output ' ,1，No.2 
model=addmf (modqdel, output ' ,1,'No.3 linear' fo0 1 0 0)7 
modqdel=adqdmf Imodel,'output ' 1 No-4' 1inear' [DO 10 0])7 
model=addmf fmodel，'output' ,Neo-5'，1linear' IO 1 0 01)7 


moeae1l=addvar (model，'output'，'d_omega',[-200,200]*PivI80) 7 

model=addmf tmoqel,'output ',2,'No.1'，,'1inear'， [al1(2,1)，0,B1(2)，0]]) 
maeael=addmf tmodel,'output' ,2，'No.2'，'1linear'，[A2(2,1)，0,B242) ,0])7 
madel=addmf tmodel，'output' 2，'NO-3' 1inear' [312,1)，0,B3(2)，0]) 7 
moael=addmf (model,'output' ,2，'No-4 linear'，[RA4(2,1),aA4t2.2)，B4(2)，0] )， 
model=addmt (Imodel，'output' ,2,'No-5'，'1linear' ,fa5(2,1) ,AR5{2.2)，B5(2)，01)7 


rulelistl=[1 11044117 
1203311: 
1305511; 
2102211; 
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17 

1 

17 

1 
3304411]; 

model=adarule (model,rulelist1) 7 


me 
Nb wm 
口 避 口 品 
Da Nu 
mw 
PP PP 


全 和 守 千 名 和 于 委 务 和 和 和 先 舍 利和 于 名 负 和 和 和 和 千 和 宙 守 和 和 各 和 千 和 和 和 于 于 昌 旨 和 名和 
ts=0.0207 
x=[9.20;0]; %ITnitial state 


for K= 





:1:100 
七 ime (KK) = 区 kx 上 SS 





六 { 攻 )}=(-1)*xevalfizsilIxtl)，xt2) tc) $%Using feedqback Control 
kO=evalfisf[x(1),X(2) ukK)] model)': %Using ftuzzy T-S moael 
=XX+ 七 名 xKO7 
YITIK)=X[1) 7 
Y2(k)=x(2)7 

enmQ 

工 iiSrre 1) 7 


subplott211) 7 

plot (time,y1) ,9rid ony 
xlabpelf'Eime(sj') ,ylabelt'angle')7 
subplot (32121 7 

plot (time,y2) ,grid ony - 
xlabelt'time(sj'j ,ylabel('angle rate' ji 


fignzreta)7 
plot (cime,uj veria ony 


xlabelt'time(s)') ,ylabel('controlier Output ) 7 


figuret3) 1 
PletmE (tc input 1) 7 
Eigurefd4)7 
DPlormt (tc imneut' 2) 7 


Showrule (tc) : 


Showrule (model) 
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3.6 基于 控制 规则 表 的 模糊 PD 控制 


3.6.1 ”模糊 控制 器 的 原理 

















模糊 控制 规则 为 : 
Rule 六 : 正 e= 此 and e= 帮 THEN = 故 《3.25) 
采用 乘积 推理 机 ， 规 则 前 部 分 的 隶属 函数 为 ; 
广 = 岂 (人 .全 (3.26) 


式 中 ，Ai(e) 和 上 1(e) 分 别 为 凡 和 睛 的 隶属 度 。 
采用 重心 方法 进行 反 模 类 化， 得 到 模糊 控制 器 : 





《3.27》 


式 中 ， 苔 的 值 由 模糊 规则 表 确定 。 
模糊 规则 表 是 根据 模糊 规则 进行 设计 的 , 每 条 规则 的 输出 z 可 由 模糊 推理 或 根据 经 验 确 
定 。 假 设 e 和 2 各 有 3 个 隶属 琢 数 ， 共 9 条 规则 ， 则 模糊 规则 表 的 形式 如 图 3-45 所 示 。 






































图 3-45 ”控制 规则 表 


3.6.2 ”仿真 程序 及 分 析 


设 被 控制 对 象 为 ; 
133 
0 
采样 时 间 为 Ims， 采 用 Z 变换 进行 离散 化 ， 经 过 Z 变换 后 的 离散 化 对 象 为 : 
yout(k) = -den(2)yout( 代 一 了 一 den(3)yout 炎 一 2)+DUm(2)R( 开 一 了 十 Dum(3J( 天 一 2 
输入 指令 信号 为 0.5sin( rt) 。 
1 隶属 函数 的 设计 


误差 e 及 误差 变化 率 上 分 别 采 用 3 个 求 属 函 数 ， 即 : 
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“orodl- 后 】 | 


ug- 叫 -[ 二 雹 ] j 


| 


隶属 函数 如 图 3-46 和 图 3-47 所 示 。 





1 


吕 De 
下 5 & 


Membership function 


吕 
六 


网 3-46 e 的 隶属 通 数 度 曲 线 


只 吕 
双双 


Membership function 
名 
思 





图 3-47 纪 的 隶属 困 数 曲线 
隶属 函数 设计 程序 ， chap3_10plotm。 


CIEar 已 了 1 了 


Close all7 


LI1=-DPI76; 
L2=Pi761; 
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L=L2-L17 
T=L*1710001 


x=LI:T:L27 
fguret1L) 7 
foer iji=1:1:3 
Ss=-[{txX+pi7y6-(i-1)*Pi76)7 (Pi712)] 27 
=exP(9S) 
hoeld on: 
plot (xyu)i 


en 


2. 控制 规则 表 的 设计 

















采用 经 验 确定 模糊 规则 表 ， 将 控制 规则 表 设 计 为 如 图 3-48 所 示 的 形式 。 
林 它 
“ N Z 了 
N -20 -10 0 
e | 了 -10 0 10 
了 0 10 20 




















图 3-48 ”控制 规则 表 














3. 仿真 实验 
采用 控制 律 式 (3.22)， 正 纺 位 置 跟踪 结果 如 图 3-49 所 示 。 
05 
得 
-05 。 
0 2 


4 Tmee) 5 8 1 
图 3-49 正 必 位 跟 踪 


控制 器 性 能 的 好 坏 决定 于 控制 规则 表 ， 而 采用 经 验 很 难 确 定 控制 性 能 高 的 规则 表 。 可 采 
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用 定性 分 析 及 遗传 算法 对 规则 表 中 规则 的 数 日 和 规则 胡 中 的 数值 进行 优化 。 
仿真 程序 一 
仿真 程序 一 : chap3_10.m。 
#%PD Type Fuzzy Controller Design 
clear all7 


close all7 
ts=0.0017 


sys=tf(133, [1,25,0])7 
Qsys=c2Q(eysS,tSs, zz ) 


[num,aqenj=tfdatatdsys，VY') 7 


e_1=0; 
u_1=07ID_2=07; 
Y-1=07Y_2-07 


for X=1:1:10000 
上 上 ime (Kk)=KxtSy 


Yinfki=0.5*simt1xpixkxts) 1 
yout (k) =-den(2)*y_1-den(3)*y_2+num(2) xb_L+num(3)x*u_21 


e(K) =zintk)-yout tkK) 
QQe(lk)=(efk)-e 1l]/trSs7 


for 11=1:1:3 
gsl=-[(etk)+piys-(11-1)*pi/6)7(pi7 12)1^27 
ul(t11)=exptgs1) 7 


end 


for 12=1:1:3 
gs2=-[(aefk)+pi7r6-(12-1)*pi76)7y tpix12)1>2; 
Lu2112)=exPlgS2) 7 


emnd 
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Fnom=fnumrul (il*u2tJh*U(i 了 )7 
tden=ftden+rultiyxu2ilj)7 
ene 


enQ 


ufki=Enum/y ffaen+0.0]1] 1 


e_1L=efklz 

2=u_ tin_1=ntk)7 
Y_2=Y_17Y-1=7OuUE (K) 7 

end 

Eigure(1) 7 
blotttime,rin，r'vtimeyyout bp) 


xlabelf TimefSs)' ) 771apelf yoOut ) 1 


Ficurel21 7 
Bles (time ez) 7 
X]ahbel('Timefts)' yylabelft e 7 


figurel3) 7 
DPloet (time ,dae，Tr') 1 
xiabelf'Timete)') ;ylabelf ac ) 


下 IT9UTS 《4 

plot (time uy 
xlabeLi'Timets) ' ) ;YLIabelI ua' 1) 
仿真 程序 二 











为 了 将 程序 模块 化 ， 把 控制 器 提出 来 ， 写 成 甬 数 的 形式 ,函数 名 为 chap3_11f， 采 用 控制 
律 式 (3.22)， 正 弦 位 置 跟踪 仿真 结果 如 图 3-50 所 示 ， 仿 真 结果 与 仿真 程序 一 相同 。 











0.5 -一 
与 
吕 0 
-05 
站 2 4 6 8 10 
Timels) 


项 3-50 正弦 位 早 跟 踪 
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士 程序 : chap3_11.m。 
8PD Type Fuzzy Conbroller Design 
C1Lear 忆 、 工 


close alli 
ts=0.001: 
sys-=cFEl133,[1,25,0])， 


dsys=c2atsys,ts， 2 1 


Tnum,qen] =ffqaraldsys， vv 





for KK=1:1:10000 
七 :me (K) = 区 < 证 局 


Tin(K)=D.5+rSsimtf1*PI*KxrE) 7 





youk tk)=-daen(t2)*y_1-dent3)*y_24mnam(2)*a_ 1I-2am(3) YL 


efk)=zintk)-Yyoot (k)7 
aqet(K)=(etk)-e_1) /ts 


Ulkl=chap3_11ffetk)vdetk)) 7 


e_1L=e 马 fk 


_15u_ 1=utk) 
Y_2=Yy_1;Y_ 1=YouEtk)? 7 


D_2 





enQ 
figuret1) 7 
plot (time,rin， rrkimeyout，b')z 


XlLabpelf'Time(Slj') 7ylabel( TYont ' ) 1 


figure(2) 7 
DBPlot (IEime ,er ) 1 


X1Labelft'TimelS) } ;ylapbelt ee 


figuret3): 
Blot (time de， r') 1 
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xlabelt'Timets)');ylabel('de') 7 


figuret4) 
DBPlot {time az) 7 


xlabelt'Timetfs)')yYyY1abel(' aa' 


控制 器 子 程 记 : chap3_11fme。 


function [y]=Eunc(x1,x2,x3) 


for 11=1:1:3 
gsl=-[(txl+pi/6-(11-1)*pi/6)/(pi/712)1^21 
udl(11) =exptgs1) 


end 


for 12=1:1:3 
gs2-=-[(x2+pjiy6-(12-1)*pi/6)AtPiZ12)]^21 
u21(12)=exPp(gs2) 


end 


U=[-20 -10 0 


-10 0 10 

D 10 20]7 
fnum=0y 
faen=0z 


for i=1: 芋 :3 
for J=1:133 
Enum=fnum+ultiyxu2(j)*UtI, jl) 7 
fden=fden+ultiyxu2( 了 了) 
ena 


end 


Y=fnum/ (fdenr0.01) 3 
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第 4 章 神经 PID 控制 


4.1 基于 单 神经 元 网 络 的 PID 智能 控制 


由 具有 自学 习 和 自 适 应 能 力 的 单 神经 元 构成 的 单 神经 元 自 适应 智能 PID 控制 嚣 ， 不 但 结 
构 入 单 ， 而 且 能 适应 环境 变化 ， 有 较 强 的 鲁 棒 性 。 


4.1.1 几 种 典型 的 学 习 规则 


(1) 无 监督 Hebb 学 习 规则 
Hebb 学 习 是 一 类 相关 学 习 ， 其 基本 思想 是 ， 如 果 两 个 神经 元 同时 被 激活 ， 则 它们 之 间 的 
连接 强度 的 增强 与 它们 激励 的 乘积 成 正比 ， 以 oi 表示 神经 元 ; 的 激活 值 ，o; 表示 神经 元 /的 
激活 值 ，wy 表示 神经 元 ; 和 神经 元 j 的 连接 权 值 ， 则 Hebb 学 习 规 则 可 表示 为 ， 
Amwg()=3oj( 伙 )oi( 大 ) 《4.1》 
式 中 ， 刀 ?为 学 习 速 率 。 
(2) 有 监督 的 Delta 学 习 规 则 
在 Hebb 学 习 规则 中 ， 引 入 教师 信号 ， 即 将 o, 换 成 希望 输出 4 与 实际 输出 o 之 差 ， 就 构 
成 有 监督 学 习 的 Delta 学 习 规则 ; 
Anwy(t =1(G (人 -oj()o( (4.2) 
《3) 有 监督 的 Hebb 学 习 规 则 
将 无 监督 的 Hebb 学 习 规 则 和 有 监督 的 Delta 学 习 规 则 两 者 结合 起 来 就 构成 有 监督 的 


Hebb 学 习 规 则 : 
Anwi(i)=Td (人 一 ok))oi(K)or(5) 《4.3》 


4.1.2 单 神 经 元 自 庆 应 PID 控制 











单 神经 元 自 适 应 PiD 控制 结构 如 图 4-1 所 示 。 














r-@ 一 [下 
5 人 


图 4-1 单 神经 元 自 适应 PID 控制 结构 


单 神经 元 自 适应 控制 器 是 通过 对 加 权 系 数 的 调整 来 实现 自 适应 、 自 组 织 功 能 的 ， 权 系数 
的 调整 是 按 有 监督 的 Hebb 学 习 规则 实现 的 。 控 制 算法 及 学 习 算法 为 
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， 
0D = wk-D+ 下 Wi(Dx() (4.4) 
气 


3 
吧 ( 人 =/ (4.5) 
所 


Wi) 二 Wi 人 (天 一 1) 士 四 (大 )2( 天 )2 (大 ) 
WE) = ma 大 一 D 十 了 zz2 (KE (4.6) 
3 人 (人 一 Ws( 开 一] 十 站 oz 到 JR 天)23 (大 
式 中 ， 为 (条 =e(k 
oa( 拉 一 et 的 一 e(K 一 1 
(= Ae(kt)=e( 扣 -2e(E-D+e 一 2 
Ze 
及， 省 。 光 。 分别 为 积分 、 比 例 、 微 分 的 学 习 速率 ， 天 为 神经 元 的 比例 系数 ， 姑 >0 。 
对 积分 I、 比 例 P 和 微分 D 分 别 采 用 了 不 同 的 学 习 速 率 ?i Jr,mp ， 以 便 对 不 同 的 权 系数 
分 别 进行 调整 。 
天 值 的 选择 非常 重要 。 帮 越 大 ， 则 快速 性 越 好 ， 但 超 调 量 大 ， 其 至 可 能 使 系统 不 稳定 。 
当 被 控 对 和 象 时 延 增 大 时 ， 天 值 必 须 减 少 ， 以 保证 系统 稳定 。 天 值 选择 过 小 ， 会 使 系统 的 快速 





4.1.3 改进 的 单 神经 元 自 适 应 PID 控制 





在 大 量 的 实际 应 用 中 ， 遂 过 实践 表明 ，PID 参数 的 在 线 学 习 修正 主要 与 e(j 和 Ae( 纪 有 
关 。 基 于 此 下 将 单 神经 元 自 适 应 PID 控制 算法 小 的 加 权 系 数学 习 修 正 部 分 进行 修改 ， 即 将 其 
中 的 xx， 人) 改 为 e(6) +Ae(K) ， 改 进 后 的 算法 如 下 : 

3 
M 了 =UED+ 天 WCGDxa( 有 (4.7) 


=] 
3 
网 (加 =wi(D7 袜 wb 
与 


(= 有 做 - 了 +Tz(COCKEJMe() 十 Ae(k)) 
oa( 阳 =r( 估 一] 二 PPz()U(E)(e( 天 十 Ae()) 
os 的 =03 人 一 D+7pz(k)u(Ee( 大 十 Ae( 有 ) 
式 中 ，Ae( 引 = e( 杂 一 < 人 一 D,z(K)=e(j) 。 
采用 上 述 改 进 算法 后 ， 权 系数 的 在 线 修正 就 不 完全 旦 根据 神经 网 络 学 习 原理 ， 而 是 参考 
实际 经 验 制定 的 。 





4.1.4 仿真 程序 及 分 析 
仿真 实例 


设 被 控制 对 象 为 : 
XR=0.36837( 人 -1)+0267(KE -2+0102(K-D+06328( 一 分 


“154， 


输入 指令 为 一 个 方 波 信号 : rin(k)=0.5sgn(sin(4rf) ， 采 样 时 间 为 Ims， 分 别 采 用 四 种 控 
制 律 进行 单 神经 元 PID 控制 ， 即 无 监督 的 Hebb 学 习 规则 : 有 监督 的 Delta 学 习 规则 : 有 监督 
的 Hebb 学 习 规 则 ;改进 的 Hebb 学 习 规 则 ， 跟 踪 结果 如 图 4-2 一 岁 4-5 所 示 。 
1 








0.5 
有 
虽 0 
皇 

， 

-0.5| | 

0 04 .06 008 | 

9 02 ”timels) “ “ 


网 4-2 基于 无 监督 Hebb 学 习 规 则 的 位 置 跟踪 (4=17 














o5 - - - 
当 
忆 0 
三 
-0.5 一 -- 
站 1 
人 0.2 0.4 timets) 0.6 08 
图 43 基于 有 监督 的 Delta 学 习 规则 的 位 置 跟踪 (AM=2) 
0.5 
习 
& 0 
三 ， 
| 
2050 02 0.4 06 0.8 1 


”Yimets) 
图 44 基于 有 监督 Hebb 学 习 规则 的 位 置 跟踪 〈M=3) 
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5 - 
0 02 04 tmels) 06 08 
图 4.5 ”基于 改进 学 习 规则 的 位 置 女 踪 (M=4? 


仿真 程序 ，chap4_1.m。 


$Single Neural ndaptive FID ConttOLLeL 


Clear 有 LT 


Close BllL1 


X=[0,09,0] 7 


XiteP=0.40: 
XiteI=0.35) 
XiteD=0.407 


&Tnitilizing kbp,ki and kq 
Wkp_l=0.107 

wki_1=0.107 

WkaG1=0.107 

%wkP_1=randy 

wki_ 
%wkd_1=rana7 





=zandy 


ErzG_1=07 
ertGYr_2=07 


07y_3=07Y_3=07 





YY 
U_1=0;uU_2=07u_3=0; 


ts=0.0017 

for k=1:1:1000 
七 ime {K) =K*tS 
zinf(k)=0.5wsigntsin(2Y2xDpix*KrtS) ) 
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YoGut (K) =0.368*Y_1+0.26xy_2+0.1ru_ 1Lr0,632x*u_27 


errocr (K) =rinfk) -yout fk) 


%aAdjueting Weight Value by hebb learning algorithm 

M=47 

E M==1 %NO Superviased Heb 1earning algorithm 
WP (K) =wWKBP_1+XiePwu_LxXi1) 多 P 
WIKI (k) =wki_1+xiLeIxu_lwX(2) 名 工 
wkd(K) =wkQ_1+xXiteDru_ lyx(3)7 4%D 
K=0.061 

el8eif M==2 &%Supervised Delta 1earming 1gorithm 
WKP (tk) =wkp_1+xiEePpxerrorIk)xD 1 务 P 
WKi (K) =WKi_1+xiEeI+errOT(K) wu 1 对 工 
wkaG(k) =wkd_1+XxieDwezTor{K)yxu_ 1 名 P 
攻 =0.127 

el8ejf M==3 %Supervised Heb 1earning algorithm 
WKP(Kk) =wkp_1+Xicepwerrot{fk)xu_1*Xt(IT) 多 了 
WKI{K) =wKi_l1+xiEeIvwerror (Kk) wu_LwX(2]7 和 多 I 
Wkda(k] =wkG_1+xiEeDxexrror (k)wu_1*x(3)7 %D 
K=0,127 

eLSeiE M==4 8IImDroved Heb learning algozrithm 
WwWKDP (X) =WkP_1+xitepwezIor(k)w>u_lw(2werror(XK)-errOo~1l) 
wki (K) =WKi_1+XiteI*errOor(K) wu_Iw12YerrOY(X) 一 erIOY~ 工 ) 


wkaQt(k) =wkd_1+xiEceDrerror(k) wu_1Iy(2werror(Kk) -errozr_1) 1 


K=0.121 

ene 
XI(1)=error(Kk)-error_17 争 己 
X{2)=errOorKK) 7 杀 工 
x{t3)=errcor(K)-2xerror_L+errOL_21 外 D 


wadatk)=abs twkp (k))+abs (wkitk))+abs(wkQ(K) ) 7 
Vw11 (k) =wkpfk) /waddtk)y 

w221k) =wki fk) ywagdtk): 

WwW33 (Kk) =wkQtk) ywaaatk) 7 

We=[Tw11L{K) ，w22(Kk)，w331K)] 1 


UK) =U_L+KAWYXT ContITol 1aw 


EUtK)>10 
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uk)=10: 


em 

if uIxy<-10 
UK)=-107 

enQ 


error 2=error_11; 


erTor_1=error (Kj] 


D_3=uU_2u_2=uU_ 1 1=utKC) 7 


-3=Yy-_2;7Y-_-2=Y_1;?Y-tL=YOUL (K) 


WwWkP_1=wKP (K) 

wkd_1=wKGIK) 1 

WKi_T=wki TIK) 

en 

figurel1l) 7 

P1LeE (timesriny pb' time, yeout， IT) 
xlabell'timels)' ;ylabellt'rin,ycut ) 1 
ESuret2) 7 

PioE(Eime ,erzOT， II 

X]labpelf timefs) ) ylabel(' error ) 7 
figuret3) 

Blot {timev ay zy 


xlabel('Eimets)') ;YLapel( au) 
41.5 基于 二 次 型 性 能 指标 学 习 算 法 的 单 神经 元 自 适 应 PID 控制 


在 最 优 控制 理论 中 ， 采 用 一 次 型 性 能 指标 来 计算 控制 律 可 以 得 到 所 期 望 的 优化 效果 。 在 
神经 元 学 习 算 法 中 ， 也 可 借助 最 优 控制 中 二 次 型 性 能 指标 的 思想 ， 在 加 权 系 数 的 调整 中 引入 
二 次 型 性 能 指标 ， 使 输出 误差 和 控制 增 量 加 权 平 方 和 为 最 小 来 调整 加 权 系 数 ， 从 而 间接 实现 
对 输出 误差 和 控制 增 量 加 权 的 约束 控制 。 

设 性 能 指标 为 : 








五 (加 = Peiatb 一 yont0b)2 二 CQA( 人 ) 《4.8) 
式 中 ，P,Q 分 别 为 输出 误差 和 控制 增 基 的 加 权 系 数 ，r(6 和 (4) 为 上 时 刻 的 参考 输入 和 输 山 。 
神经 元 的 输 岂 为 ; 
3 
=MKE-D+ 故 mu 人 zi 人) (4.9) 


is 
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3 
(= ww 人 人 GE=12.3) 


i=1 


3 
1 二 W roml as (6-CE 》 (wm 《DT (DT 中 


3 
We 大 ) = Wo ( 玫 一 ] icon (DO-CK》 《Wi (天 mo] 


1 


3 
Wa3{R 一 Ya 天 -or 可 As-er 袜 ov (KDJ momo 


记 


式 中 ，8 为 输出 响应 的 第 - -个 值 ， 且 有 : 
(RD) = e( 
(=e( 昌 -ee 开 -D 
与 ( 昌 =Aze( 阅 =e( 和 -2eK-D+ekk 一 轨 
2Z(K) = e( 友 ) 


4.1.6 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 过 程 模型 为 : 


《4.107 


《4.11) 


yout( 上 = 0.368yout 人 一 D+0.264yout 开 一 2 二 一 GD) 十 0.6328(K 一 如一 了 二 七 (下 ) 


应 用 最 优 二 次 型 性 能 指标 学 习 算 法 进行 仿真 研究 。E(k) 为 在 100 个 采样 时 





sd00=010 ， 输 入 为 阶 跃 响应 信号 rn)=10 。 启 动 时 采用 开 


闻 的 外 加 干扰 ， 
环 控制 ， 取 


&=0.1726, 玉 =0.02,P=2,Q=1.4=6. 比 例 、 积 分 、 微 分 三 部 分 加 权 系 数学 习 速 率 分 别 取 
刀 =47 =120.7。，= 159, (0) = 0.34,w(OD = 0.32,wa(0)= 0.33 ， 神 经 元 自 适 应 PID 位 置 跟 


踪 及 控制 过 程 中 权 值 变 化 结果 如 图 4-6 和 图 4.7 所 示 。 


1.4， 1 一 一 一 





rinyout 








05 0 0 
" 905 timals) 0 


15 0.2 0.25 


图 46 : -次 型 性 能 指标 学 习 单 神经 元 自 适应 BID 位 置 跟踪 
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图 4.7 单 神经 元 PID 控制 过 程 中 权 信 变化 


仿真 程序 ，chap4_2.m。 

gSingle Neural Net PID Control1ler based on Second TYPe Learning Rlgorithm 
Ciear al117 

Close all1 


xc=[D,0,0] 1 
K=0.02;P=2)Q=tid=61; 


xitep=1207 
XiteI=47 
xiteD=15917 


Initil1izing jp,ki and ka 
WPR_1=Ianad; 
wki_1=rana' 
WKkG_1=Tand， 


Wkp_1=0.347 
Wki_- .32 
WKG_I=0.331 





eTTOI_T=07error_2=01; 
Y_L=0OIY_2=07 
u_l=g.1726;1u_2=0iu_3=07u_4=0;u_5=070U_6=0;u_7=0; 
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ts=0.001; 
for k=1:1:2350 
time(k) =kxtsy 


Fin(k)=1.0; 8Tracing Step Signal 
Ym(XK)=0; 
if k==100 


Yymtk)=0.10;: 8$Disturbance 
enda 
yout (K)=0.368*yY_1+0.26*y_2+u_6+0.532*u_7+ymfk) 


erroT(K) =Tinkx)-yYouttk) 7 


WAX= [wkP_1l,wkG_l,wki 1]7 


WUX=WXKAXC 了 


Po=yout (1)7 

KK= 虽 .0E757 

WKkP (k) =wkp_1+XttePrKr[PxbOrerror(k)xxclfT) -QQ*KrwXsXC(1) ] 
Ki (和 ) =wki_1L+XiLeI*KA[PrbOxerIor(K) wxXCI2)-QxKrWXxXCf2)] 7 
WKG {K] =wkad_1+xXibeDyKr[PxbOrerrorik)*xel3) -OrxKrWXxXC(3) ] 了 


XC(1)=error (K)-error_ 1 多 也 
xcft2)=error tk) 多 工 
Xct3)=error (k)-2xrerror_1+errOT 21 多 了 


wada(K)=abs (wkpik))+abs(wkitK))+abs(wkQtk)) 
mL (K)y=wkp(k) /wadatkl 

W22{K) =wKi IK) wadqd(Kk) 

Ww33 (Kx =wkdtk) ywadq (Kx) 7 

W=[w11(K)，w22 (kk) ,w33(kK)] 


LIK)=U_L+RAWwXCT 委 ContEol 1aw 


if utf(K)>10 
uk)=10; 

end 

IE utk)<-10 
UKk)=-10: 


en 把 


errOT_2=errOr_17 


LTOL_1=error (K) 
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7=uU_6;u_6=-u_5:u_5-u_ 4in_ 4=u_31 


3= 





Fkp_1=wkPtK) 7 
wkq_1=wkatk) 
Wi =wki(K) 7 


27n_2=u_1;L_1=utlk) 7 


Y-2=yY-17Y-1=Yout (K) 


en 


figuret2]7 


PLeLE (ime Tin， Time Yout， 虽 )》 


xlabel('Lime(s)');ylabelt'rin,yout' 
figuret27? 7 

ploL (Line uy err 

X1abclf'timefts) ) ;ylabelf aa 7 
figuref3) 1 


Subplotr1311)1 7 


ploc (cime ,wkp，er ii 


xlabelf'imefts)')7ylabelt'wkp' 17 


subplot (312) 


plob (Lime,wkiyer' 


Xlabclt'time(s)')7Yiabelt'wki' ) 


SubPJIer (313) ) 


DPILOE(Eimey wkGQ er ) 


X1labelt'timelts)') 7 


Yalabel (wka') 


4.2 基于 BP 神经 网 络 整定 的 PID 控制 
4.2.1 基于 BP 和 神经 网 络 的 PID 整定 原理 


PID 控制 要 取得 较 好 的 控制 效果 ， 就 必须 通过 调整 好 比例 、 积 分 和 微分 三 种 控制 作用 ， 





形成 控制 尹 中 既 相 下 配合 勾 相互 制约 的 关系 ,这 种 关系 不 一 定 是 简单 的 “线性 组 会 ”从 变化 


和 咎 
向 
久 而 


图 4-8 BP 网 络 结构 


无 穷 的 非 线性 组 合 中 可 以 找 出 最 佳 的 。 神 经 网 络 所 具有 的 任意 非 线 
性 表达 能 力 ， 可 以 通过 对 系统 性 能 的 学 习 来 实现 具有 最 佳 组 合 的 
PID 控制 。 采 用 BP 网 络 ， 可 以 建立 参数 操 ， 占 ， 台 自学 习 的 PID 
控制 器 。 

基于 BP(Back Propagation) 网络 的 PID 控制 系统 结构 如 图 4-8 
所 示 ， 控 制 器 由 两 部 分 构成 : 


(1) 经 典 的 PID 控制 器 ， 直 接 对 被 控 对 象 进行 几 环 控制 ， 并 内 二 个 参数 操 ， 太 ， 镶 为 


在 线 调整 方式 。 
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《2》 神 经 网 络 ， 根 据 系统 的 运行 状态 ， 调 节 PID 控制 器 的 参数 ， 以 期 达到 某 种 性 能 指标 

的 最 优化 ， 使 输出 层 神经 元 的 输出 状态 对 应 于 PID 控制 器 的 三 个 可 调 参数 后 ， 辣 ， 司 通过 神 
经 网 络 的 自学 习 、 加 权 系 数 调 整 , 使 神经 网 络 输出 对 应 于 某 种 最 优 控 制 律 上 的 PID 控 缸 器 参数 。 

经 典 增 量 式 数字 PID 的 控制 算法 为 : 

天) 一 (天 一 ]) 十 ARCR) 

AD) 一 各 (error (了 问 -error 伙 -DJ)+KeTTOor( 了 + 大 (error( 一 22rror 伙 -D+error 开 一 轨 ) 《4.12》 
式 中 ， 玉 ， 太 ， 避 分 别 为 比例 、 积 分 微分 系数 。 
采用 二 层 BP 网 络 ， 其 结构 如 图 4-8 所 未 。 
络 输入 层 的 输入 为 : 





O 凡 = 区 及 (= 上 2 ,44) (4.13) 
式 中 ， 输 入 变量 的 个 数 M 取决 于 被 控 系统 的 复杂 程度 ， 
络 隐 含 层 的 输入 、 输 出 为 ， 


昌 
5( 丰 二 (GOD 
2 妆 用 “ (4.14) 
OQ(D= fonetP(6) G=E2…O) 
式 由 ， wy 为 隐 含 层 加 权 系数 ， 上 角 标 1)、(2)、(3) 分 别 代表 和 输入 层 、 耻 含 层 和 和 输出 层 。 


隆 层 神经 元 的 活化 函数 取 正 负 对 称 的 Sigmoid 困 数 ， 
GO =tbmbh0O = 所 -ee (4.15) 


已 十 它 

















网 络 输出 层 的 输入 输出 为 : 

act- 这 op 
=0 

OO=8gCnet (ED)) (=12,3) 
Of(D= 操 (4.16) 
OB( 阳 一 帮 
OO 人 (= 加 

输出 层 输出 节点 分 别 对 应 三 个 可 调 参数 太 ， 五 ， 玉 。 由 于 如 ， 右 ， 恕 不 能 为 负 值 ， 所 

以 输出 层 神经 元 的 活化 函数 取 非 负 的 Sigmoid 曾 数 ， 

zCD=J0+tanhoD)= 


《4.17) 





ee 
取 性 能 指标 请 煞 为 ; 
ED = 二 CinlD 一 youtOP (418) 
按照 梯度 下 降 法 修正 网 络 的 权 系数 ， 即 按 B(t 对 加 权 系 数 的 负 樟 度 方向 搜索 调整 ， 并 附 
加 - 个 使 搜索 快速 收敛 全 局 极 小 的 惯性 项 


op-= 志 全 各 +oank (419 
人 


式 中 ， 刀 为 学 习 速 率 ; C 为 惯性 系数 。 
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3E( 曲 365(D 9( 间 Ar 890 9net (有 























Dw 全 一 DO aaAx0D 05 (有 BanetB(D Do 人 (420) 
和 各-o OP(D (4.21) 
由 于 -Ke) 未 知 ， 所 以 近似 用 符号 咀 数 sgn| - 叶 ( | 取代， 由 此 带 来 计算 不 精确 的 影响 
DAx(k) DAx( 有 
可 以 通过 调整 学 习 速率 妖 来 补偿 。 
由 式 〈4.12)》 和 式 (4.16)， 可 求 得 : 
DAu( 拉 _ 四 
5050 =eror( 上 一 error( 类 一 ]) (4.22) 
人 =error( 扫 (4.23) 
2 = error( 上 ) 一 2error( 大 一 DJ)+ error( 天 一 2) (4.24) 
上 述 分 析 可 得 网 络 输出 层 权 的 学 习 算法 为 : 
AmwB(O=aAnp-D+T6DO0(b 《4.25) 
昌 _ D( 丰 1 BAMK( 扣 2 = 
2 -ao 总 人 ro (天 (=12.3) 《4.26) 
同 理 可 得 隐 含 层 加 权 系 数 的 学 习 算 法 : 
Aw 久 (人 = OhAw 岂 -DA+T8DOY (人 (4.27) 
5 Paet20D) 六 5 012…9) (4.28) 
名 
式 中 ，gO=8C00-800)，FO=0-P 产 00)12。 (4.29) 





某 于 BP 网 络 的 PID 控制 器 结构 如 图 4-9 所 示 ， 该 控制 器 控制 算法 归纳 如 下 








T 


各 直 
mm mn emer os 
一 BID 
和 业 
出 


图 4.9 基 寺 BP 网 络 的 PID 控制 器 结构 

(1) 确定 BP 网 络 的 结构 ， 即 确定 输入 层 节 点 数 M 和 隐 含 层 节点 数 C， 并 给 出 各 层 加 权 
系数 的 初 值 wb(0) 和 wo (0) ， 选 定 学 习 速 率 和 惯性 系数 w， 此 时 大 =1; 

(2)》 采样 得 到 rin(k) 和 yout(k) ， 计 算 该 时 刻 误差 error( 妇 =rin( 刀 一 yont(e) 

(3) 计算 神经 网 络 NN 各 宏 神 经 元 的 输入 、 输 出 ，NN 输出 层 的 输出 即 为 PID 控制 器 的 
二 个 可 调 参数 后， 右 ， 和 总 ; 

(4》 根据 式 (4.12) 计 算 PID 控制 器 的 输出 xi ， 

(5) 进行 神经 网 络 学 习 ， 在 线 调整 加权 系数 wo) 和 w 和 P(k) ， 实 现 PID 控制 参数 的 白 
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(6) 置 上 = 大 +1， 返 回 到 (1)。 
4.2.2 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 的 近似 数学 模型 为 : 
GE(E)YoUL 天 一 | 
yontD 一 2 四 一 中 
式 中 ， 系 数 a( 扫 是 慢 时 变 的 ，afDD=120-08e 0 。 
神经 网 络 的 结构 选择 4-5-3， 学 习 速 率 = 0.28 和 避 性 系数 w= 0.04 ， 加 权 系 数 初始 值 取 
区 闻 [-0.5,0.531] 上 的 随机 数 。 输 入 指令 信号 分 为 两 种 : 
(Cl rin(ej=1.0， 
(2) rin(g)=sin(27rt) 。 取 3 = 时 为 阶 路 跟踪 ，3=2 时 为 正弦 跟踪 ， 初 始 权 值 取 随 机 


值 ， 运 行 稳定 后 用 稳定 权 值 代替 随机 值 。 其 跟踪 结果 和 相应 前 曲线 如 图 4-10 一 图 4-14 所 示 。 


十 ER 一 ]) 











0 02 08 1 


04 06 
time(s) 
图 4-10 阶 跃 响应 曲线 (9 = 1 








4 0 0.8 1 
tmets) 


图 4-11 参数 自 适应 整定 同 线 
由 于 可 调 参数 后， 上 后， 如 均 取 非 负 的 Sigmoid 函数 ， 其 值 在 (0, 0) 之 问 ， 使 得 本 算法 的 应 
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用 有 具有 局 限 性 ， 读 吉林 根据 需要 进行 改进 。 


1 - 





05 


finyout 
口 


-0.5 












































” ? tin 记 Ge) 5 6 
阁 4-12 正弦 跟踪 遇 线 《3S=2) 
0.01 关 一 - 
0.005 
三 0 
昌 
-0.005 
] 
ofL _- 
0 1 3 丰 
timets) 
图 4-13 ”跟踪 误差 曲线 
04[ 一 - _。 
AAA 人 
55 1 2 3 4 5 6 
0.8- 
” AAA 
0.4 
0 1 2 3 4 5 6 
o3f 
届 vv 
02 ， _ 
0 1 2 3 4 5 厂 


timels) 


图 4-14 参数 自 适应 整定 曲线 
仿真 程序 ，chap4_3.m。 
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$BP baseq PID Contrcl 
安 1eaa 工 己 1 工 7 


Close all1: 


Xite=0.207 
中 fa -0.057 


&Signal FyPe 





;Out=3) SNHN Structure 





有 Step Signal 





IE 3= 
-0.6394 -0.2696 -0.3756 -0.702317 





-0.8603 -0.2013 -0.5024 -0.25955 
-1.0749 0.5543 -1.6820 -0.54371 
-0.3625 -0.0724 -0.6463 -0.2859; 
0.1425 0.0279 -0.5406 -0.7660]: 
swi=0.50*ranas1H,IN) 
wai_1=wiywi_2=wiywi_3=wii 
wo=10.7576 0.2616 0.5820 -0.1416 -0.1325) 
-0.1146 0.2949 0.8352 0.2205 0.4503; 
D.7201 0.4566 0.7672 0.4962 0.3632117 
swo=0.50*randstOut ,HB): 
wo_L=wojwo_2=woiwo_3=wor 


endq 


IE S== SSine Sigmnal 

0.2846 0.2193 -0.5097 -1.0668: 
-0.7434 -0.1210 -0.4708 0.-0988; 
-0D.7176 0.8297 -1.6000 人 .204 
-0.0858 0.1925 -0.6346 0.03477 

0.4358 0.2369 -0.4564 -0.1324]7 








Ss%wi=0.50xranQs(H,IH] 

wii_1L=wiywi 2=wi7wi 3=w7 

wo=[1.0438 0.5478 0.8682 D.1445 
0.1316 口 ,5811 二 .1214 口 .5067 D.73307 
1 .0063 0.7428 1 工 .0534 D.7824 0.649411 


D.-15377 


swo=0.50*ranas (Out ,H) 
wo_L=wojwc_2=wolwo_3=wor 


enQ 
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x=[0,0,0]; 
Qu 1L=0; 





U_1LI=0Iu_2=0;u_ 3=0;uU_4=07u_5=07 


Y_1=0ivy_2=0;y_3=0) 





Ohb=zeros (H,1)) 8Output from NN midale layer 
I=oh'; SITnput ro NMN miadle Tayer 
error_2=01 


erTOT_1=0: 


上 S=.0017 
for K=111:6000 
上 ime tkK)]=Ky 七 日 


iT S==1 
zinftk)=1.07 


elseif S= 





工 iP{Kk) =Sinf1y2*RPiwKx 世 ) 7 


enq 


gsUnlinear model 
atk)=1.2x(1-0.8*exPt-O-1LxKk) ) 7 
Yocut (K) =(K)*y_1LAL1T+Y_1^2)+U_ 1 


erFOT{K) =TintXKy-YyOur(K3 
xi=[rintk),yout(k) ,errortk) ,1]7 
XIL)=erTOL (K) -erTrOFr- 7 
(2)》=erTOTIKT 

X1(3) =error(K) -2+errOr TI+errOr_27 
epiG-Txfl) ;xft2)7xft3) 7 


工 =Xi*wi 


for j-1;1: 





ohtjj=lexpftI())-expl-Il0)))7Atexp1I())+exp(-I())) 8SMiddle LayeT 
end 
KK=wOx*Ohy &%Dutpur LayeI 
for 1=1:1:0OuF 
只 人 ) =exp{ 区 (1)) 7 (exP(KIL) )+eXP{t- 区 (IT) )) 了 g%Getting kb,kiyka 
en 


Jp (k) =K(UL) kitk)=KI217kQtK) =K(3) 了 
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KPiaG= [kP(k) ,kitk) ,katk)]; 


Gu (k)=Kpiarepiay 
utK) =u_l+autk]y; 


Gyutk)j=signft(yout (kj)-y_1)7tau(k)-du_1+0.0001)) 1 


8Output layer 

for j=1:1:0ut 
QGRK{) =27(expfK())+expt- 区 OO)))^27 

enq 

for 1=1:1:Out 
Gelta3(1)=error(k)*dyu(k)*epidtI)*GK(1) 1 


end 


Ecor 工 = 工 





Out 
fcer i=13:1 
Q_wo=xiterdqaelta3(1j*oh(i)+alfaxr(wo_L-wo_2)1 


:8 





ena 
end 

wo=wo_1+q_woralfar(wo_l-wo_2)1 
&Hidden layer 
for 1i=1:13:H 

ao(i=4/(exptI{i) )+exp(-I(i)) 27 
enQq 

segma=delEa3xwoy 
for i=1:1:H 

aelta2(i) -doti)*segmali)y 


emnq 


G_wi-xitexdelta2 xxii 


Wi=wji_1+Q_wi+alfax (wi_ 1-wi 2)7 


&ParameterSs Update 
au_1=dutk)y 
u_5=u 4;u_4=u_3yu_3=u_2;u_2=u_1;u_1=utk)， 


Y_2=Yy_1; 


=YyYout (K) ; 





WO_3=wo_2: 
WO_2=wo_17 


WO_1L=woj 
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wii_3=wi 21 
wii_2-wi li 


ii 


eTITOF_2=etror 二 7 

error_: -errorlk)， 

end 

figurell) 7 

Dlos ttimerin riime ycut， 5b') 7 
xlabe3 (cimels)j' jzylapezfrrinyyout' ly 
下 SUEet2) 


plot (ime error zi 





Xlabelt'tjmets)' yylabelt'error') 1 
figuret3) 

DPIoE Itinre ur 7 
Xlabel1l'Ligelsl' 3ylabedzl'u' 1 
EiguEeld4) 

Subp]le=(311) 7 

BPlot (time,kPp， IT) 了 

xladbe] (timets) ilabpelf ka 
Subp]lotr (1312} 

ELoL tmey kg 
X1abelf'timefsl') ;YIabelf kz ) 1 
SubploL(313)7 

plot [Lime ,ka py 

xlabelf timetes) ylabelt ka') 7 


4.3 基于 RBF 神经 网 络 整 定 的 PID 控制 
4.3.1 RBF 神经 网 络 模型 


径 向 基本 数 (Radial Basis Function，RBF) 神经 网 络 足 由 工 Moody 和 C. Darken 在 20 世 
纪 80 年 代 末 提出 的 一 种 神经 网 络 , 它 吓 具有 单 隐 层 的 三 层 前 馈 网 络 。 由 于 它 模 拟 了 人 脑 中 局 
部 调整 、 相 互 柳 盖 搂 收 域 〈 或 称 感受 野 ，Receptive Field) 的 神经 网 络 结构 ， 因 此 ，RBF 网 络 
站 - 神 局 部 逼近 网 络 ， 已 证 明 它 能 以 任意 精度 遥 近 位 意 连续 酌 数 。 


1 网络 结 构 


RBF 网 络 是 ”种 三 层 前 向 网 络 ， 由 输入 到 输出 的 映射 是 非 线性 的 ， 而 隐 含 层 空间 到 输出 
穿 加 的 映射 症 线 性 的 ， 从 而 大 大 加 快 了 学 习 速 度 并 避免 局 部 极 小 问题 。 
RBF 神经 网 络 结构 如 图 4-15 所 示 。 
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疼 4-15 RBF 神经 网 络 结 


2. 被 控 对 象 Jacobian 信息 的 辨识 算法 


在 RBF 网 络 结构 中 ，X-fo，x …，z 开 为 网 络 的 输入 问 量 。 设 RBF 网 络 的 径 向 基 间 量 
下 [jj 其 中 为 为 高 斯 基 函 数 ; 








ee | -5 4430) 
285 
网 络 的 第 / 个 结 点 的 中 心 矢量 为 CrIcinei 
设 网 络 的 基 宽 向 晤 为 : 
加 =, 思 

已 为 节点 的 基 宽 度 参 数 ， 且 为 大 于 霍 的 数 。 网 络 的 权 向 量 为 ， 

开 -won (4.31) 
辨识 网 络 的 输出 为 ，; 

因而 + 有 二 十 WPn 帮 《4.32》 
辨识 器 的 性 能 指标 函数 为 ; 

deutD -yn (4.33) 


根据 梯度 下 降 法 ， 输 出 权 、 节 点 中 心 及 节点 基 宽 参数 的 迭代 算法 如 下 : 
(= Wi 做 -D+ 有 (youtl) 一 和 (DO) 忆 +GOw 人 -Di 人 2) (434) 


ke-cjf 
Ab = (yout() -~ yw 和 本 (4.35) 
已 ( 虽 = 可 全- 有 +DAD TCD 全 -0D- 忆 大 一 2 (4.36) 
天 Ci 
Acnr =(yout( 打 一 DA (4.37) 
/ 
cr( 昌 =ch(-D+IAcpTQCCr 人 -cz 人 -2 (4.38) 


式 中 ,m 为 学 习 速率 ，& 为 动量 因子 ， 
Jacobian 阵 〈 即 为 对 象 的 输出 对 控制 输入 变化 的 灵敏 度 信息 ) 算法 为 : 


DO bm 避 5 
Da -mw 《439) 
aax0 ”aax( 产 ”， 本 








式 中 ， 国 =An( 。 
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4.3.2 RBF 网 络 PID 整定 原理 


采 几 增 显 式 PID 控制 器 ， 控 制 误 差 为 
error {K) = Tin (大 ) 一 yout (天 ) 


PID 一 项 输入 为 ; 
Xefl)=error (K) 一 errofr (大 一 1 
ef2) = error (天 )》 〔4.407) 
Xe(3) = error (大 ) 一 2error (天 一 1) +error (大 一 2) 

控制 算法 为 : 


有 (好 一 开关 一 ]) 十 Ak( 天 ) 
Ar(K) = 各 (crror( 妇 一 error( 开 一 DJ 二 和 error(K) +Aa(error(K) 一 2error( 大 一 +error( 天 一 2)) (4.417 
神经 网 络 整定 指标 为: 











已 (天 ) = 于 emer (CD (0442) 
后 ,ja 的 调整 采用 梯度 下 降 法 ， 
Ak =- 作 共 = -了 芝 全 党 =1error( 且 ) 六 xc 《4.43) 
A5 = - 芝 = 二 和 和 党 = 1lerror 四 议 - ac) (4.44) 
Al = 可 加 = 二 加 全 党 =?jerror( 且 也 xc(3) (4.45) 


式 中 ， -站 为 被 近 对象 的 Jacobinn 信息 ， 可 通过 神经 网 络 的 尖 识 而 得 。 
RBF 整定 PID 控制 系统 的 结构 如 疼 4-16 所 示 。 


， a You 
小 Sor| plD 对 旬 |- 一 











时 























RBF 购 络 ymout 





图 4-16 RBF 网 络 整定 FID 控制 框图 


4.3.3 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为 : 
一 0.lyoutk-D+&K-TD 
1+ yout( 大 一 TD 
给 入 指令 信号 为 rn(D= LOsgn(sin(2rf)) ，RBE 网 络 结构 选 为 3-6-1， 网 络 辨识 的 二 个 输 


Yout(K) = 
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入 为 : Arv(K),yout(K),yout(K 一 D) 。M =1 时 为 RBF 整定 的 PID 控制 ， 其 
图 4-19 所 示 ，M =2 时 为 未 加 整定 的 PID 控制 ， 其 结果 如 图 4-20 所 示 . 
1 - 
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WiyoULt 
品 





1 
?95 timets) 


图 4-47 RBF 整定 PID 控制 方 波 响 应 《M=1) 


04 一 - - 





Jacobian value 








了 
timels) 
图 4-.18 ”对象 Jacobian 信息 的 辨识 结果 




















站 .人 - - - 
| 
双 0.05 - 
j 
o%0 0.5 1 4.5 2 
0.4 站 
三 | 
00 05 一 1.5 2 
o1- - - - 一 
20 一 一 一 一 
| 

0 ， _ 
0.5 1 1.5 2 
9 time(s) 


图 4-19 参数 自 适应 整定 曲线 


结果 如 图 4-17 一 
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rin yout 
品 





05 1 T5 2 
time(g) 


图 4-20 未 整定 的 PID 控制 方 波山 应 “Mf=2) 
仿真 程序 : chap4_4.m。 


%adaptive PID control based on RBF Identification 
仑 全 工 人 工 ， 


IO 全 并 


Xite=0.257 
己 ]Ta=D0 ,057 
belte=0.01; 
X=[0,0,0] 7 


ci=30*ones(3,6) 7 
bi=-40*ones(6，1) 7 
Ww=IDOxoness 16,1) 7 


h=[0,0,0,.0,0,0] :7 


ci_1=circi 3=-ci lyci 


bi_l1=birbi_2=bi 1;bi 











W_1L=wiW_2=w_17w_3=w_ 17 
U_1=077-_1=07 
Xc=[0,0.0] 


error_1-gierror_2_0ierror=01 


skp=ranG11) 7 
8%ki=randt1) 1 
%kd-=randf1] 1 
kpD-=0.03; 
Ki0=0-01: 
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kg0=8 .037 


kP_ 工 =KPD7 
qd_1=kG07 
Ki_1L=kiCr 


xitekp=0.20; 
xirekd=0.201 





XIEeki=0.207 





=0.0017 

for KkK=1:1:2000 

Lime tk) 一 Ky7 
Tinfky=1.0*sign(sint2x*rpixkxrcS)) 17 


Yeut tk)={f-0.1*yL+uU_L)7 (LT+Y_L 217 g%NOn1inear P1aUL 


fcr j=]:1:6 
HOU)=exRBft-norrm(x-cit:y lj)^27 (2*bithrPitj)))7 
em 


ymout (xj=w' hr 


昌 _w=Qx7 





focr j 
d W( 刘 =xitex(yourfk)-ymouc(k))*htjyy 
eng 


ww_1+G_w+ralfaxrtw_1-mw_2)+Delte* (w_2-W 3]1 


己 _ pi=0x*bji7 





fcr j-1:1:6 
abil3i-=xites (yout (kj-ymout (kjj*wtjjshtjjx*(tbi(J)^-3)snorm(x-citi 3j))^27 
end 
-bi_1+ qd_biralfartbi_1-bi_2)+beltex(bi 2-bi 3)7 


fear JJ= 工 






geciti,I)=xiLex (yout(kl-yImout(tk)lxw(3ixht)xtxti) -cirtiy 了 ))rtbit) -2) 7 
eng 
eDg 


ci=ci_ lia_ciralfartci 1l-cj_2)+beltextci_2-ci_3) 7 


“175 


革 秆 于 锡 和 和 和 各 先生 澳 种 负 条 负 和 和 第 负 于 和 和 本 忆 CO 斌 间 mi 生 秆 宙 全 先入 多 和 信和 宙 年 务 务 仙人 虽 生 唱和 告 向 
Yu=0; 
for jc=l:1:6 
Yu=yu+wltj)*htj)*(-xf1)+cif1 jj)ypitj)^27 
end 
Gyout (Kk) =yuy 
第 村 先 秽 于 下 和 和 和 和 和 条 名 入 甸 和 和 各 条 针 务 先 S 上 ar OF COLTOT SYS 七 rn 知客 和 和 名 币 务 名和 当 客 各 竺 各 客 名 各 名 
error(K) =rintk)-Yout (K) 7 
Xp (X) =kP_1+xitekpxerror (K)*Gycut(k)xxct1)7 
kd (k)=kG_1+xitekdxerror (kj*dyout (kJxxcf2)7 
Ki (KJ)=ki_1+xiteKkirerror(k)*Gyout (K) wxcf(3) 7 
iE kp (kj<0 
Xp (K)=05 
ena 
计 Exkqa(k)<0 
kq(k)y=07 
enQ 
E ki (0k)<0 
Ki (kj)=07 


en 包 


M=17 
Switch 
Case 1 工 
case 2 8%ontly PID Conttol 
Jp (kk)=kp0; 
ki tk)=Kio7 
ka(k)=xkq07 
end 
du(k] =kp(k)*xct1)+kG(k)+xct2)+Ki(k)wxC(3) 7 
uk) =u_l+au(k)z 


多 ReLUIYE Of 了 arameterS 
X{(1)=Gutfk) 3 
X{2)=yout (K) 7 
XI3)=Y_17 


D_Ii=u(k) 1 
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xc {1)=error fkK) -error_1; &Calculating P 
Xc t21=errOr (K) -2*errOT_I+error_27 %Calculating 也 


Xe (3)=error tk) 7 $Calculating 工 


eLYOT_2=errOr_117 


etot_ 1=errortKkj7 


KPI=kKP (KE) 
Ka_1=kdtk): 
Ki_1=kitfk)7 








ena 

于 guret]) 
Blot (imey Tin rp' time yout，'I :7 
xlabelt'timefts)')7ytabelf Timny yout ) 
figuret2) 1 

BPloc timevyout，" 





timevymout ,by 
XLabelt'time(s)');yIapeI( Yout,ymout ") 了 
figurel3) 7 

Plotfttimevdyout) 
xlLabelt'time(s)'))ylabel('Jacobian Value'") 7 
figure(t4j7 

subplot (311) 17 

Piecttime,kp，z7)7 
xlabelt'timets)');yl1abel('kp' 7 

subpLot (312) 


DBLOE KEime ki Er 7 
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xlabel('timels)')7ylapell'ki')7 
Subplott313) 1 

Dlot (time,kd， rr 1 
xlabelt'timets) 15y1abelf'ka') 


4.4 基于 RBF 神经 网 络 辨 识 的 单 神经 元 PID 模型 参考 自 适 应 控制 
4.4.1 神经 网 络 模型 参考 自 适 应 控制 原理 


4-21 示 出 单 神经 元 PID 模型 参考 自 适应 控制 系统 框图， 单 神经 捷 PID 作为 控制 器 
NNC，RBF 网 络 作为 辨识 器 NNJ， 实 现 对 韦 控 对 象 的 Jacobian 信息 辨识 。 




















rat 


参考 模型 出 


[| NNC | 对 象 > 


| KANE 人 


AN 
图 4-21 单 神经 元 PID 模型 参 才 白 适应 控制 系统 柜 聊 





rm 
























































单 神经 元 网 络 的 输入 为 : 
ci()= error( 大 ) 
xca(1) 一 (error( 提 一 erTOT(K 一 DZ (4.46) 


上 
xc3(K) 一 error(DT 


k1 


神经 网 络 的 输出 即 为 控制 器 的 输出 : 





3 
MD= 》 wci(E)xci(R) (4.47) 
气 

神经 网 络 控制 器 的 学 习 算法 采用 delta 学 习 规则 ; 

E= Jeror(o -二 Crout(D- youtOP 《448) 
9 OFE 9gy 9 D7 
=- =- 3 = 大 (4.49) 
Amwci( 下 )= 一 中 3 人 下 和 aoc Terror(K) 7 xci(K) 


式 中 ， 包 为 被 控 对 象 的 Jacobian 信息 ， 通 过 RBF 神经 网 络 的 辨识 而 得 。 


4.4.2 仿真 程序 及 分 析 


仿真 实例 
针对 一 阶 传 递 函数 进行 单 神经 元 PID 模型 参考 自 适应 控制 ， 被 控 对 象 为 : 
1 


GO- 
0 0003 +0007 了 
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采样 时 间 为 lms，3S=1 时 ， 输 入 指令 信号 为 正弦 信 叶 ，38 =2 时 ， 输 入 指令 信号 为 参考 
模型 。 取 S= 2 ， 参 数 辩 识 、Jacobian 信息 准 识 及 正弦 位 置 跟踪 结果 如 疼 4-22 一 图 4.24 所 示 。 
参考 模型 指令 信 吴 为 : 
rin( 旭 =0.50sin(0.006mk) 
yrout( 拉 =0.2yrout( -1)+0.6rin() 


0.4 





吕 
四 


口 


Yout,ymout 


-0.2 








0.2 0.4 06 08 1 
timets) 


图 4-22 ”参考 模型 辨识 结果 





Jacobian value 


局 





0.2 0.4 0.6 
tmets) 


图 4-23 Jacobian 信息 辨识 结果 


0.4 





yroutyout 
品 
避 六 


名 
加 





-04 





0.4 0.8 上 
timels》 


图 4-24 正弦 位 置 跟踪 
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仿真 程序 : chap4_5.me。 


%Single Neural Net PID Controller baseq cn RBF Identificaricn 


Cliear alliciese all7; 


Jp=0.0030;pp=0.067: 
ts=0.0017 


Gp=cftfl]， [JP,Ppp,0]) 7 
Gpz=c2dtGpts， 2z') 1 
[numy,Qen]=ttGacafGbz， rw 


h=zeros16,1)7 
8w=Tanas (6，1) 7 
WwW=[-0.56461 

自 .39373 

一 日 ,555 各》 

站 .39817 

间 .44951 

0.2565]1 


负 _1=W7WL_ = 3=W 


Xite=0O.401 
己 LTfa=0.051 
Pelte=0.017 


x=[0,0,0177 


sc=0.1*ones(3，6)1 
8b=g -lx*ones(6,T) 7 
c=[-3.1829 -0.5211 7.1754 11.6631 -3.6992 
-3.8909 “2.3999 5.1730 8.5871 -11.3737 
-4.2018 2.6742 5.1828 。 8-5238 -1.8936 
bp=[ S.3074; 

1.4771; 

26.4114; 

22.1716; 

52.9082; 

5.690617 
cC_L=crc_2=c_1ic_3=c_21 
;b_2=b_Lib 3=b 27 





-10.9150; 
.01791 
一 吾 .1845] 7 





XCcC=[0,.0,0] 





xitrec=0.60; 


kp=80; 
kaq-5; 
ki=50; 


wC=[kp,kd,kily; 


WC_L=wciwc_2=wCIwWC_3=wCi 


erTOor_ 1=0Oierror_ 2=017 
y_1=0jy-2=0) 
u_1=0ru_2=07 


ei=G 


C_size=sizeftc)7 


for K=1:1:1000 
七 ime (KK) =KxtS) 
intk)=0.50*ein(3x2*PIixKxES} 7 


S=21 
E S==1 
yrout (K) =1.0xrintk) 7 
em 
守 E S==， 
yrout (K) =0.2xy.-1+0.6*rin(k); 8sReference Modael 


endq 


$LDimear TOQel 


yout (kj =-qen(2)*y_1-aenf3)*Yy_2+numl2) xu_ lenum(3)wu 27 


for j-t:l:c_sizet(2)， 
ht)=expl-normtx-c_1t:,j))^27(2xb 1t() xb 1())) 
enq 


ymout (k) =w_1'xhy 


ia=apbs (YOUE (Kk) -ymout (K ) 7 
iiE ia>0.0001， 
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$%------------- ----adjusting RBF Dararmeters----------------------- 和 
amw=Dww; 多 Defining matrix number of G_w equal Lo that of 史 
fer j=1:13:6 
Q_wtj) =xitex (yeut (k) -ymout (k)) enht)y 


W=W_1+Q_w+ 冯 1fax(w 1-w_2)+belter(w_2-Ww 3)7 
第 条 多 车 向 种 各 秆 千 千 于 各 各 负 下 和 范 竺 各 负 各 省 吾 各 甸 水 秆 唐 膏 澳 尼 各 第 乞 藻 币 秃 朱 务 省 和 利 宣 多 枯 和 先 备 名 备 各 各 笛 和 久生 各 条 阁 于 
局 pb-OxDp 





for j= 


日 bt)=xiLex (yout (K)-Yymout (kj))*w_1()*h(J)x (bl1tj)c-3)xnormtx-c_1(:) 327 
enqa 
Db=b_i+ 以 b+alfar*(b_l1-b_2)+beILe*(b_2-b 3) 7 
生 和 和 后 和 和 和 人 和 允 时 于 全 和 和 生生 和 向 估 和 和 和 和 和 和 名 全 和 先天 和 和 于 各 当 和 和 于 和 和 和 名和 和 人 各 各 和 





actiyjhj=xitexfyout {K) -ymout(k))xw_10)sntj*tx0)-c-Tti) tbp-T() -2)7 
em 

emnQ 
cr=c_1+d_c+alfar(c_I-c_2)+beltev(c_2-c_3j1 

emnd 

移 咎 入 名 旬 先 入 先生 和 和 CalLCUTatimng JacODpian 贡 于 利和 洁 先生 名 午 侍 惠 先 向 

ayu=05 

for j=1:1:c_sizet2) 
ayu=ayutwtj)xsh(tj)*(-xtl)+clt1r3))/b(t) “27 

end 

Gyout (K) =qyuy; 

入 省 入 和 各 务 忆 二 上 愉 me 七 人 ES 有 民 忆 II 生生 种 备 省 告 名 

error (k) =yrout (k) -yout (kj 7 

xct1)=error(k)7 

xc(2j=(errortKk)-error_ 了) AS 

ei=ei+error(k) ts 


xct3)=ei:; 


UKk)=wcwxci 多 Control 了 am 
if uk)>10， 
utk)=10 
em 
if wufxk<-10， 
utK)=-107 
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end 


Q_wc=Dxwcr 多 Defining matrix number of G_w equal to that of w 
for 了 =1 





Q_wet)=Xitecxerrotr(kl*xc(])xaGyout{k)7 
ena 
WC=WC_1+_wWC+BLEar WwWC_ 1-wC_21+Dbelter(wc_ arwc 3)7 
error_2=error_1ierror_1-error(k) 1 


U_2=u_ 1 lL=ufk): 
Y_2=y-1;7_L=YOouULIK) 7 


Xf3)=Y_2; 
XI2) =Y-17 
Xf1L)=u 1; 


W_3=w_27W_2=Ww_15wL_ 1 





c_3-c_2;c_2=c_1;c_1 





P_3-b_2;b_2-b_1ib 1-b; 





wec_3=wc_37wc_2=wc_iiwc_1=wcr 

engq 

Eiguret]l) 7 

ploer ttime,youb，r'vtimeymout，b' ly 
xlabelt'tinmels)');ylabel( youkymout ) 7 
figuret2) 7 

BlottEtime,dyout ,ri 
xlabelft'time(s)')7ylabel('daccobian value') 1 
Eigure(31 7 

DBPloc ttimeyyrout， pr，Lime ycut， 
xlabel('timels)')iylabel('yTout,yout 3 
figuret4) 1 

BlLot (time,yrout-yout， 


xiabelit'time(s)')rylabel('control error' 1) 7 


4.5 基于 CMAC (神经 网 络 ) 与 PID 的 并 行 控制 


4.5.1  CMAC 概述 


小 脑 模型 神经 网 络 (Cerebettar Model Articulation Controller，CMAC) 是 一 种 表达 复杂 非 
线性 冰 数 的 表格 查询 型 自 适应 神经 网 络 ， 该 网 络 可 通过 学 习 算法 改变 表格 的 内 容 ， 具 有 信息 
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分 类 存储 的 能 力 。 

CMAC 把 系统 的 输入 状态 作为 一 个 指针 ， 把 种 关 信息 分 布 式 地 存 入 一 组 存储 单元 。 它 本 
质 上 是 种 用 于 映射 复杂 非 线性 函数 的 俘 表 技术 。 有 具体 做 法 是 将 输入 空间 分 成 许多 分 块 ， 每 
个 分 块 指定 一 个 实际 存储 器 位 置 ; 每 个 分 块 学 习 到 的 信息 分 布 式 地 存储 到 相 邻 分 块 的 位 置 上 ， 
存储 单元 数 通 常 比 所 考虑 问题 的 最 大 可 能 输入 空间 的 分 块 数 少 得 多 ， 故 实 规 的 是 多 对 一 的 映 
射 ， 即 多 个 分 块 映射 到 回 样 一 个 存储 器 地 址 上 。 

CMAC 已 被 公认 为 旦 一 类 联想 记忆 神经 网 络 
性 喘 射 。CMAC 算法 可 有 效 地 几 于 非 线性 孙 数 远 j 
其 他 神经 网 络 的 优越 性 体现 在 : 

《1) 它 是 基于 局 部 学 习 的 神经 网 络 , 它 把 信息 存储 在 局 部 结构 上 ， 使 每 次 修正 的 权 很 少 ， 
在 保证 丽 数 非 线 性 逼近 性 能 的 前 提 下 ， 学 习 速 度 快 ， 适 合 于 实时 控制 ; 

(2) 具有 - 定 的 泛 化 能 力 ， 即 所 谓 相 近 输入 产生 相近 输出 ， 不 同 输入 给 出 不 同 输出 ; 

(3) 连续 〈 模 拟 》 输入、 输出 能 力 ， 

(4) 寻 址 编程 方式 ， 在 利用 串 行 计算 机 仿真 时 ， 它 可 使 回响 速度 加 快 ; 

(5) 作为 非 线性 道 近 器 ， 它 对 学 习 数 据 出 现 的 次 序 不 敏感 。 

由 十 CMAC 所 具有 的 上 述 优越 性 能 ， 使 它 比 一 般 神经 网 络 具 有 更 好 的 非 线性 逼近 能 力 ， 
更 适合 主 复 杂 动 态 环境 下 的 非 线性 实时 控制 。 

CMAC 的 某 本 思想 在 于 : 在 和 输入 空间 中 给 出 一 个 状态 ， 从 存储 单元 中 找到 对 应 于 该 状态 
的 地 址 ,将 这 些 存 储 单元 中 的 内 容 求 和 得 到 CMAC 的 输出 : 将 此 响应 值 与 期 望 输出 值 进行 比 
较 ， 并 根据 学 习 筑 法 修改 这 些 已 激活 的 存储 单元 的 内 容 。 

CMAC 的 结构 如 图 4-25 所 示 。 








要 组 成 部 分 , 它 能 够 学 习 任 意 多 维 非 线 
、 动 态 建 横 、 控 制 系统 没 计 等 。CMAC 较 

















AC 杂 散 编 码 


= 输入 向 重 APIWY 









































输出 









































1 输入 空间 


图 4-25 CMAC 的 结构 


4.5.2 一 种 典型 CMAC 算法 及 其 仿真 


CMAC 网 络 由 输入 层 、 中 间 层 和 输出 层 组 成 。 在 输入 层 与 中 间 层 、 中 间 层 与 输出 层 之 间 
分 别 为 由 设计 者 预先 确定 的 输入 层 非 线性 映射 和 输出 层 权 值 自 适应 性 线性 映射 。 

在 输入 层 对 记 维 输入 空间 进行 划分 。 中 间 层 由 若 十 个 某 函 数 构成 ， 对 任意 一 个 输入 只 有 
少数 几 个 基 函 数 的 输出 为 非 斑 值 ， 称 非 零 输出 的 其 函数 为 作用 基 函 数 ， 作 用 基 函 数 的 个 数 为 
泛 化 参数 c， 它 规定 了 侗 络 内 部 影响 网 络 答 出 的 区 域 大 小 。 

中 间 层 基 函 数 的 个 数 用 P 表示 ， 泛 化 参数 c 满足 c<s<p。 在 中 间 居 的 枯 函 数 与 输出 层 的 
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网 络 输出 之 问 通过 连接 权 进 行 连接 。 采 用 梯度 下 降 法 实现 权 值 的 调整 。 

CMAC 神经 网 络 的 设计 主要 包括 输入 空间 的 划分 、 输 入 层 至 输出 层 非 线性 映射 的 实现 太 
箱 出 层 权 值 学 习 算法 。 

CMAC 是 前 镶 网 络 ， 输 入 输出 之 阅 的 非 线性 关系 由 以 下 两 个 基本 映射 实现 。 





1. 概念 映射 (U 一 AC ) 


概念 映射 是 从 输入 空间 U 至 概念 存储 啥 AC 的 映射 。 

设 输入 空间 向 量 为 本 =[pzop…ae] ， 量 化 编码 为 [wo1， 输 入 空间 映射 全 AC 中 < 个 
存储 单元 〈c 为 “ 进 制 非 零 单元 的 数目 )。 

采用 下 式 去 示 上 映射 后 的 向 大 

丽 =S(DD=[nGt) ss 人 vs 《4.50) 

式 中 sen)=1 =12 mc。 

英 射 原则 : 在 输入 空间 邻近 的 两 个 点 (一 个 点 表 示 一 输入 的 二 维 向 量 )， 在 AC 中 有 部 分 
的 重 登 单元 被 激励 。 叱 离 越 近 ， 重 登 越 多 ， 距 离 越 近 ， 重 登 越 少 。 这 种 映射 称 为 局 部 泛 化 ,< 
为 泛 化 参数 。 








2. 实际 映射 (AC 一 AP) 


实际 映射 是 由 概念 存储 器 AC 中 的 e 个 单元 ， 用 编码 技术 〔 如 杂 散 编 色 》 映射 至 实际 作 
储 器 AP 的 c 个 单元 , e 个 单元 中 存放 着 相应 权 值 。 网络 的 输出 为 AP 中 e 个 单元 的 权 值 之 和 。 
若 只 考虑 单 输出 ， 则 输出 为 : 





>= 色 ws 《4.51) 
名 
即 : 
= 六 w， (4.52) 
jl1 
只 中 国 = 区 四 ww。 
CMAC 采用 的 学 习 算 法 如 下 : 
采用 8 学 习 规则 调整 权 值 ， 权 值 调 整 指 标 为 : 
正 = 工 en? (4.53) 
2c 


式 中 ，e(D=rD-yD。 
由 梯度 下 降 法 ， 权 值 按 下 式 调整 : 


An (D= 二 是 - TCD- 2 .由 -2 (4547 

Diw 人 9wm 让 
zjD=wi-D+AwD+aetwdG-D-wiG-2) 《4.55) 
= 区 (4.56) 


式 中 ，a 为 民 性 系数 。 
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4.5.3 仿真 程序 及 分 析 


仿真 实例 
采用 CMAC 网 络 辨识 下 线性 对 象 ; 
YU =ak-D2 +3yKDAKL+7KE-D2) 
取 HB 作为 网 络 的 输入 , 采 几 线性 化 鹃 数 对 输入 状态 进行 量化 , 实现 CMAC 的 概念 映射 : 
(大 )} 一 md ee 一 Xin 反 志 一 | 
9 


ax 一 Ain 





式 中 ，xzmis 和 xux 为 输入 的 最 大 、 最 小 值 ，j 杂 为 zx 量化 后 所 对 应 的 最 大 值 。 
采用 杂 散 编码 技术 中 的 烧 贸 余数 法 实 天 CMAC 的 实际 映射 。 设 杂 凌 表 长 为 四 ， 以 元 素 值 
s(DHi 除 以 鞭 数 N CNSsm) 后 ， 所 得 余数 加 1 作为 杂 凌 地 址 ， 实 现 了 实际 映射 ， 即 ; 
ad{ 门 =(s( 纪 +E MOD N)+1 
式 中 ，i=12 ec。 
在 仿真 中 ， 取 HH=100，N=7， 取 汪 化 参数 c=7,1 =1.5,a=0.05。 仿 真 结果 如 岁 4-26 所 示 。 


1T.5 一 -一 








几 4-26 CMAC 的 辨 识 


仿真 程序 : chap4_6.m。 
8CHaC Idencificatiorm for nonlinear moael 


Clear 习 ]17 


close al11 
xite=1.57 
alifa-0.051 
M-=1007 

了 = 

C=71 


mw=zerosfiNy， 1) 1 


gwW=Tands (村 1 ) 了 
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1 
了 2=wi 


Q_w=wy 
D_1=07 
Y_I=97 


tsS=O.001: 


for K=1:1:500 


二 ime (K)=K*ts7 


QtK)=sinf4x2xwPpixkx 世 SS) 7 





5 (kj) =roundf (fu tk) -xmin)sMA(XImax-xrmjin)) 7 g%Quanmntity 


Sum=0: 

for i=1:13:C 
aafi)=modfes[k)+ivI)+1L7 $Table mapping ang Hash transferiStart address 
sum=sumtkwtadfti)]; 


enq 


Yym (kj=sum' 


$Nomlinear moqel 


YIK) =u_1^3+y_17t1L+Y-1c2) 17 


errCT{K) =Y(k) -ymtk) 


Q_w=Xitexerror (K) LAC7 


for ji=1:1:C 
adti)=modts(k)+H)+1L7 
witadti))=w_ ltae(i))+ Qw+alfaxrtw_ltaati))-w 2tadti))) 7 


end 


$g%S 和 ParameterS Update 和 和 $8 
2=w 1 


本 1=w7 
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UL_IL=ut{k) 7 

Y_1=Y(k) 1 

end 

figure(l] 

BlLottEtime,y，'D' ,time ym rr 7 
xlabel('timel(s) )7yiabel( yym' )， 


4.5.4  CMAC 与 PID 复合 控制 算法 


CMAC 一 开始 就 被 应 用 于 机 器 人 控制 中 ， 有 眼前 有 多 种 控制 形式 ， 如 CMAC 直接 逆 运 动 
控制 、CMAC 前 馈 榨 制 、CMAC 反馈 控制 等 , 本 书 采用 的 是 CMAC 前 馈 控 制 。CMAC 与 FID 
复合 控制 结构 图 如 峡 4 .27 所 示 ， 该 系统 通过 CAMC 和 PID 的 复合 控制 实现 前 馈 反 馈 控 制 ， 

















重 化 |->| 地 址 吹 负 | 一 >| cuacat |>| CMAC 函数 计算 


m 了 [西天 | CD 人 
图 4-.27 CMAC 与 PID 复合 控制 结构 图 

01) 小 模型 神经 控制 器 实现 前 馈 摔 制 ， 实 现 被 控 对 象 的 道 动态 模型 ， 

(2) 常规 控制 器 实现 反馈 控制 ， 保 证 系统 的 稳定 性 ， 且 抑制 扰动 。 

CMAC 采用 有 导师 的 学 习 算法 。 每 一 控制 周期 结束 时 , 计算 出 相应 的 CMAC 输出 心 ( 吕 ， 
并 与 总 控制 输入 wk) 相 比较 , 修正 权重 , 进入 学 习 过 程 。 学 习 的 目的 是 使 总 控制 输入 与 CMAC 
的 输出 之 壮 最 小 。 经 过 CMAC 的 学 习 ， 使 系统 的 总 控制 输出 由 CMAC 产生 。 而 常规 控制 器 
采用 传统 的 PD 算法 而 不 用 PID 控制 算法 , 使 CMAC 的 学 习 仅仅 依 束 于 误差 的 当时 测量 值 及 
变化 值 。 

该 系统 的 控制 算法 为 : 















































(DJ= > Wigi (4.57) 


[| 
HR) 一 za (大 ) 十 Rp{ 大 ) 〈4.58) 
式 中 ，e 为 二 进 制 选 择 向 量 ，e 为 CMAC 网 络 的 泛 化 参数 ，x( 昌 为 CMAC 产生 相应 的 输出 ， 
司 罗 为 常规 控制 器 PID 产生 的 输出 。 
在 这 里 ，CMAC 概念 映射 的 方法 为 : 输入 空间 8 在 区 间 [Soin Smu] 上 分 成 AH2C 个 量化 间 
唤 ， 即 : 
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人 


min 


岂 =rA， (ji=c+heee+N) 《459) 
Vserl Yue 一 So 
CMAC 实际 映射 的 方法 为 : 
1 若 Sjeiv vel,j=c+lce+AN 
2 二 《4.607 
0 其 他 


取 指令 信号 rin(K) 作为 CMAC 的 输入 。 每 一 控制 周期 结束 时 ，CMAC 输出 属地 ) 与 总 控 
制 输出 wk) 相 毕 较 ， 修 正 权 重 ， 进 入 学 习 过 程 。 学 习 的 目的 是 使 总 控制 输入 与 CMAC 的 输 
出 之 差 最 小 ， 即 使 系统 的 总 控制 输出 主要 由 CMAC 控制 器 产生 。 











CMAK 的 调整 指标 为 : 
克昌 = 工 ws(k) 一 MD)2 二 (4.61) 
2 < 
AD -3E0D -ED-m(D。 -01 人。 (4.62) 
Dw C C 
(有 一 mw 一 1 二 Aw() 二 GO) 一 m( 天 一 D) 《4.63) 


式 中 ，1 为 网 络 学 习 速 率 ，7Ee (01) ，C 为 惯性 量 ，wes (0 。 

当 系统 开始 运行 时 ， 置 w=0， 此 时 =0，x= 好 ， 系 统 由 常规 控制 器 进行 控制 。 通 过 
CMAC 的 学 习 , 使 PID 产生 的 输出 控制 量 内 (kt) 逐渐 为 零 , CMAC 产生 的 输出 控制 量 各 (b) 逐 
渐 通 近 控 制 哄 总 输出 Ki 。 


4.5.S$ 仿真 程序 及 分 析 


仿真 实例 
被 控 对 象 采用 二 阶 传递 函数 : 
1770 
GT6051770 

CMAC 神经 网 络 参数 取 N=l00，C=5，1=010，w=004 。PID 控制 参数 取 
与 =25, 占 =0, 避 =028 ， 采 样 时 间 为 lms。 取 输入 信号 为 方 波 信号 ，M =2， 跟 踪 结 果 如 
图 4-28 和 图 4-29 所 示 ， 其 中 图 4-29 分 别 给 出 CMAC 控制 器 、PD 控制 器 和 总 控制 器 的 输 
出 。 





(rin and 几 





-0.5 
0 





02 0.4 0.6 0.8 1 
time (s) 


图 4.28 方 波 信号 跟踪 
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介 DO2 94timefs) 06 


图 4-29 各 个 榨 制 器 的 输出 
仿真 程序 ，chap4_7.me。 


&%CMAC and PITD Concurrent Control 
Leaz 忌 T1 


Cl1ose 引 L17 


ts=0.0017 
sys=tf(1770,[1,60,1770]); 
] 


[num,Qen] =tEaatatasys wh 





QSYS=C2Q(SYS， CS Z 


已 1 研 呈 =D .中 4 了 


N=1007C=57 


w=zeros (N+C,1) 7 


到 1=WIW_2=W Ga_W=WT 


Y_1=0JY_2=0;7_3=01; 
U_1=0.0iu_ 2=0.0ru_3=0.0; 


X=[0.0,0] 7 


ezTor_1=07 


$Square Wave Signal 
-0.507 
Smin=-: 
Smax= 有 7 


Xite=0.107 
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JPp=2S7 
Ji=0-0; 
Ka=0.2817 


scCoGing Tnpur value 


gvi= (Smax-Srmin) 0-l) 


for 1i=]1:13C 利 C SFe 
viI=Smin 
eng 


tor ji=er1323C+H 








Ti)=vtiTL)+ 


ena 





for 1i-NrC+Lr1:Nr2xC SC SG 





Vi=Smax' 


emnQq 


for Kk=1:1:1000 


二 ime fky》 =K*tS7 


rintk)=arsignfsii12*2*Dpivkxrto1l 1 9Squcxrc Signa- 





for ii=1:232N+C 


了 nk TV 


有 人 )》=1 
ES 

己 (I) =07 
enQ 
enq 


ycut tk)=-denf2)*7 Ti-derf31x3_2+nunt21x0 +numt3)*u _ 21 


errOT{Kk)=Tin(K) -YUELK) 


SCMAC Neural Netwozk Controller 


UnD (gs) =aaxw 7 


%PID Control1ec 
3 () =KP*XTfL)TKQrXT2)+KTYXT 
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M=27 
守 EM==1 &Only Using PTD Control 
uk)=uptk) 








elseif M==2 %Total control oucput 
ukK)=uPIk)+untk) 


eng 
IE k==150 &DiSstUrbarce 
Qtky=u(ki+5.07 


扣 DQ 


iiE utk)>=10 


ufK)=107 
eng 
jf ulk)<=-10 
UK)=-107 
ea 


8%Update NN WeightL 
Q_w=a'x*xitertutk)-un(kl)7Ccy 


We=w_1+ Q_W+aTfaxr (fw_IL-wW 2) 7 


gsParameters UPdate 
3=W_27W_2=W_17W_T=W7 
U_2=u_ 1:u_1L=utk) 


Y_2=y_1;Yy_1=Ycout tk) 


XIfT)=erceorik)lz 旬 Calcularing 号 
X(2)=(Ierrortx) -error_1)7cs' 多 Calculating D 
XI(3) =Xf3)+erzoOIT{kK)YtS 儿 Calculating 工 


error_2=error_j1rerTor_1L1=errOLr(K) 

end 

下 ESGnITe 人) 了 

Blor (timeTriny ktime yout， kz 
xlabel('time(s)');ylabel(t' (zin and Y) 1) 7 
figuret2) 7 

SubPIoL (3T1) 7 


plot (time unek')i 
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xlabelt'Eime(s)') 771Labelt'uan')7 
subploLt312) 7 

PPlLot (time,uP，K 
xlabetl'rime(s)' 7yiabelt up')7 
subpior 313] 7 

DlorIEtime uk' li 
xlapelf'cimets)')7y1abel('u' ji 
于 iiSurel3] 7 

Per ttimey error，' 7 


xlabel('timetsl' ) ;ylapel(t error ) 7 


CMAC 控制 算法 虽然 是 由 PD 榨 制 器 的 输出 训练 的 ， 但 并 不 是 PD 控制 器 的 简单 复制 。 
加 入 PD 控制 器 为 了 评 浏 CMAC 控制 器 的 性 能 ， 增 强 系统 的 稳定 性 ， 抑 制 扰动 。PD 单独 
控制 时 ， 增 益 大 的 值 在 很 人 程度 上 决定 着 控制 效果 , 而 采用 PD+CMAC 控制 时 控制 效果 不 依 
赖 于 态 的 值 ， 妨 的 值 只 需 在 一 个 合理 的 范围 内 即 可 。 

通过 仿真 结果 可 以 看 出 ， 开 始 的 时 候 主要 是 常规 PD 控制 器 起 作用 ， 经 过 对 常规 控制 器 
的 输出 的 不 断 学 习 ， 逐 渐 由 小 脑 模型 的 输出 起 控制 作用 。 小 脑 模型 的 加 入 使 得 控制 效果 比 单 
独 的 PID 控制 效果 要 好 很 多 ， 当 方 波 〈 阶 跃 ) 输入 时 ， 大 大 减 小 了 超 调 ， 加 快 控制 响应 速度 ， 
充分 体现 了 小 月 模型 的 特点 ， 即 输出 误差 小 、 实 时 性 好 、 重 棒 性 强 等 。 

在 加 入 干扰 的 情况 下 ,会 发 现 由 于 CMAC 的 加 入 使 得 干扰 作用 下 的 控制 系统 很 快 地 恢复 
稳定 状态 。CMAC+PD 并 行 控制 在 一 定 程度 上 克服 了 常规 控制 器 所 不 能 避免 的 一 些 问 端 ， 使 
控制 效果 得 到 提高 。 


























4.6 _CMAC 与 PID 并 行 控制 的 Simulink 仿真 


4.6.1 Simulink 仿真 方法 





采用 Simulink 仿真 实现 CAMC 和 PID 的 并 行 控制 。 通 过 Simulink 仿真 ， 可 以 使 得 控制 
结构 看 来 更 加 清晰 。 

采用 调用 M 函数 的 形式 来 编写 CMAC 神经 网 络 控制 器 和 PID 控制 器 ， 指 令 信号 类 型 是 
在 厅 函 数 中 实现 的 。 通 过 选择 $ 值 不 同 的 输入 信号 来 实现 阶 跃 、 方 波 和 正弦 信号 的 跟踪 














4.6.2 ”仿真 程序 及 分 析 


仿真 实例 

取 采 样 时间 为 Ims， 被 控 对 象 采用 -- 阶 传递 函数 Gy(s) =1770Ms + 608+1770) 的 离散 方 
式 为 : 
0.0008674z+0.0008503 


Gp(z)= 
了 2z2 一 1.94z+0.94]18 
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控制 系统 二 Simulink 得 序 来 实 网 ， 手 制 系 统 中 的 CMAC 和 PLD 控 | 
实现 ， 即 chap4#_ gmlm 和 chap4_8m2Jm 
在 日 D 控制 W 示 数 让 





两 个 1 函数 来 








1 采用 了 perxisten 命令 实现 纪 
苇 Clock 实 届 参数 的 初始 化 
为 阶 跃 信 
AC 控制 好 十 数 中 利用 财 炸 Clock 功 能 宇 ; 
网 络 参数 取 N=300，Css，nT=U，z=1o4 





Jalobul 命令 实现 
的 类 型 ， 其 中 S=1i 









Simulink 仿真 时 间 取 15， 仿真 反 
11) 阶 跃 响应 ， 在 Simuiink 程序 中 避 
驴 =040, 大 = =028 。 阶 响 厅 








鸣 应 输入 ， 在 M 函数 中 取 S=1，PID 参数 到 








2) 方 波 员 应 : 在 Simulink 程 床 中 取 方 玻 响 应 输入 ， 幅 值 为 050， 频 率 为 4Hz。 在 1 
函数 中 取 S=3，PID 参数 肥 上 =1001, 上 = 大 =028 ， 方 波 殉 应 图 4-31 所 未 











用 431 


仿真 程序 1，Simulink 程序 chap4_8mdl， 如 图 寻 32 所 示 
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MATLAB 
Fanctton 











mac conmtrol 






MATLAR 
Fanction 





id cemmol 
Sal 
Gengrator 


[95008674z+0.0008503 


















王 -1947109418 


Diserete 
lanstcr Fen 

















Scope3 















OPe2 
器 


图 4-32 Simulink 控制 仿真 结构 图 
仿真 程序 2: 用 于 PLD 控制 的 M 函数 chap4_8ml.m。 


function [ul=chap4_8ml(ul,u2,u3) 
global s 
Bersistent errori erTOr 1 


ts=9.0017 

if u3==D 
erIOT1T-O7 
ertor_1=07 


endq 


2 %Selecting Signal Type 
8SEep Sigmal 


&Square Wave Signal 





ka=<0.287 
end 
errOL=U2: 


exrTOrd= (errOr-eTFOY_1) /ES1 





FEOLi=eILOTIL+eITLOT* 巧 By 


U=kPpreTLIOr+KQ+rerrOrG+kixerrOri7 


FFOL_1=error 


仿真 程序 3: 用 于 CMAC 控制 的 MH 函数 chap4_8m2.m。 
functicon [u]=chap4_8m2(uI,a2,u3, und) 

global 8 

Persistent W X] X2 X3 W_1 W2 了 
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N=3007 
C=51 


守 Eu3==0 


=ZzerO8B{N+CL) 





#SEep Sigmal 





Smax=17 





elseif s--2 ， $%Sauare Nave Signal 
Smin=-9.57 
Smaxs<Q .51 


engq 


Xite=0.17 


Qvwji=fSfmax-Smin)y(tN-1) 7 


Ecor TI=13:13C &C Siz 安 
Tt)=Sminy 

ena 

for TI=C+1:13C+N SSize 
vi)=VIi-IL)+avi 

eD 电 

for ii=N+C+rl:1:N+2xC 多 C SITEZe 
VD)=Smax7 


eng 


in=uli 
for i=13:1:N+C 


让 Tin>=V(i)&zin<=Vfi+C) 





BTEOTK-DZ 7 


U=up+uny 钊 TDEaL ConIO- 





Q_w=a'wxitevupACi 


W=W_ 1+Q_WwW+BlEarfw dm 2 
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2=w 1 





4.7 基于 Hopfield 网 络 的 PID 模型 参考 自 适应 控制 


4.7.1 系统 描述 


典型 的 伺服 系统 速度 环 框图 如 图 4-33 所 示 。 





curpuL 








| 


电流 环 























Ce 








速度 环 动态 方程 为 : 


即 ; 


式 中 ，y 为 转动 惯量 ，! 为 电流 控制 输入 ， 速 度 指令 为 mw = 负 ， 实 际 速度 为 v=6 。 


理想 参考 模型 定义 为 : 


图 4-33 何 服 系统 速度 环 框图 











(4.64) 
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《4.65) 
式 中 ，mm 为 参考 模型 的 速度 。 


参考 文献 [12]， 将 电流 环 控制 器 设计 为 “P 控制 + 前 馈 控 制 ”的 形式 ， 


了 = 站 (wa 一切 + 大 网 《4.66) 
将 式 (4.66) 带 入 式 〈4.64)， 并 整理 ， 得 ， 


， 灵 天 天 天 克 
io 生生 全 5 
令 : 


7 十 丰 (4.67) 
得 : 





了 = 一 天 FT 二 天 Gya 
Hopfield 网 络 的 输出 加 以 整定 。 
4.7.2 基于 Hopfield 网 络 的 控制 器 优化 


《4.68) 
式 中 , 下 和 G 为 待定 的 控制 器 参数 ， 末 及 








Hopfield 网 络 结构 如 图 4-34 所 示 。 









































图 4-34 Hopfield 网 络 结构 
Hoptield 网 络 的 能 量 函 数 取 : 


瑟 = 工 人 一 从? 


二 《4.69) 
将 式 〈4.68) 带 入 式 (4.69) 展开 得 : 








亚 -3 十 K2F2V2 十 天 2G2v2 jekFsv-2kcwm -2K2FGwm) 


取 Hopfield 网 络 输出 神经 元 数 为 2， 假 设 输 入 电阻 无 穷 大 ， 此 时 Hopfield 网 络 的 标准 能 
量 函 数 为 : 


《4-70) 
河 
将 本 展开 得 ; 
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1 ， 
否 N 三 -3 十 avtva 十 了 ya + Y 太 一 pp 
令 m = 忆 v =G， 得 : 
[ 
EN = 人 @ +ToEG+TDIFG+TG) -GD 
当 Hopfield 网 络 处 于 平衡 状态 时 ， 能 旺 阴 数 最 小 ，T = 7 ， 此 时 

















3 _ 2E_ 
OF OF 
3 有 3 _ 
90G 3G 
EN _ 蚜 
一 =0， 
BF 3F 得 
9 1 
恕 = 了 27F-T2G-mG)-A=LC27F-27aGJ-n=0 
于 = 了 um +2Kbay 一 2 天 2Gywaj=0 
由 上 面 商 式 得 : 
人 = 天 972， 了 := 了 = 天 ?vd ， 厂 = 一 Koy 
3E 3 
2Es -5 -0， 
3G 38G 得 ， 
BE 
这 = 并 -下 -272G)- 瑟 - 芒 2T:F -272G)- 厂 = 
3 1 ， 
乞 =5eean 2 -2oyu -2k2Po)-0 
由 上 面 两 式 得 ， 


五 = 名 os 加， = 
通过 上 面 推导 得 到 连接 权 垂 阵 了 和 外 部 输入 7 如 下 : 


22 
=| 下 | Tsw up] 《471 
更 TH 一 天 1 
标准 Hopfield 网 络 的 动态 方程 为 : 
CG 骆 -六 Tt (4.72) 





全 
取 Ci =10， 将 所 求 的 了 和 了 带 入 王 式 得 ; 
侣 -Ti +-28G0D+knugla) 一 ay 
dt 





二 十 Ta 人 十 五 = 开 ya8( 的 ) 一 天 wa2g() 十 有 ay 
取 神 经 元 输出 的 非 线性 特性 为 : 
2 ， 
20 0D= TD 二 1 12 《4.73》 
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网 络 实际 输出 为 ， 





下 一 SG6D) 
G=8C2) 
由 于 1+erom 一 2 ，1+erims = 23 ， 则 有 ， 


上 2 
3S-FC+HSP_M2 -证 ) 
F+S (23 2S' 


dF __ -23e (2) _ 
辆 7 





273， 


2 2 
开 - 申 -aa 人 - 严 放 K2v2FTR2naG_A no) (474) 
dd 出 231 
同 理 可 得 
aG -4 人 2-c9) 
dz 2532 
2 
上 -ad 2 -Gaor_ boacyEn) (4.75》 
df du 由 2 


求解 微分 方程 式 (4.74) 和 式 〈4.75)， 可 得 到 优化 后 的 F、G， 从 而 实现 操 和 矿 的 整定 。 
4.7.3 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为 : 


上 
中 ，J = 一 ， 则 K=17=60. 
式 60 


仿真 结果 如 图 4-35 一 疼 4-38 所 示 。 其 中 网 4-35 为 速度 距 踪 结果 ， 图 4-36 为 控制 信号 的 
输入 ， 贸 4-37 和 图 4-38 为 控制 器 参数 如 和 大 的 变化 过 程 。 


30 一 一 - -= 








二 队 
> 


Speed tracking 
蕊 








of 一 站 四 
0 0.2 0.4 0.6 0.8 
timets) 


图 4-35 速度 跟踪 结果 
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Control input 


08 


0.4 tmeG) Q6 
疼 436 控制 信号 输入 








0 0.2 0 4 0.6 08 1 
time(s) 


图 4-37 往 的 变化 过 程 


0.2 - 一 





0.15 ， 


kf 


0.1 


0.05 








0 0.2 04 tmele) 06 
疼 4-38 所 的 变化 过 程 


仿真 主 程序 ，chap4_9.m。 


SPID control based on HopfielQ 
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Clear all: 


ClLDSse 中 1 





ts=0-00 





TimeSet=[0:ts:1]7 


Para=[]7 


[L,X]J=cde451" chap4_9eq' TimeSert [0000],[] ,Para): 


Vm=Xf:y，1L1 7 





-=x1:,3] 1 
G=xtf:v4) 1 


va=30; 
I=-F.*v+Gxrvay 


kf-G-kpy 


figure(1): 
DobIt wm er tv PbvGe OK 
xlabel('time(s)') yylabel('speeQ tracking' ) 


下 计 Dzet2) 
PILE 人 EL, 工 ， 工 ) 


xlabell'timets)' ;yl]abelf'control input') 7 


figurel3) 7 
Blet tt KP， 1 
Xlabelf'timetsli')7ylabel('KP')7 


下 SUTetqa) > 
D1Let (此 KE， 工 
XLabel( "time(s)') ;71L1abelt kt) 


子 程序 ，chap4_9eq.m。 


function Gx=DynamicMoael 必 ,X,flagrpara) 


Gx=zeros (4,1) 7 


TV=X2)1 
下 -X(3) 了 
G=X(4) 7 
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vd=307 


mrmmna=0.01: 
mmn2=0.017 


S1=17 
S2=17 


T=100*0D.0017 多 100ms 
KRK=607 


I=--F*v+Gr*vd) 


Qxt1)=-1ZTAx(1T)+1AT+vGz 

Qvm=Gxt1l)7 

QGX123)=K* 工 7 

QGxXI3)=nrmnly (2*S1)*(S1^ 2-F^2)w (~ 民 “2xV 2xF+K 2xVdrVxG-K*dwmsv) 7 
Gx1i4)=nrmn27(2*S2)w (82^2-G 2) 1-K 2wVxVQAF-K^2*VQ^2xrG+KxGvmyVO) 


4.8 基于 模糊 RBF 网 络 整定 的 PID 控制 


4.8.1 ”模糊 神经 网 络 结构 


图 4-39 示 出 模糊 RBF 神经 网 络 结构 ， 该 网 络 由 输入 层 、 模 糊 化 层 、 模 糊 推理 层 及 输出 
层 构 成 ， 网 络 输 出 为 铝 ， 右 ， 禹 。 





图 4-39 模糊 RBF 神经 网 络 结构 


在 参考 文献 [13] 中 ， 将 模糊 RBF 网 络 中 信号 传播 和 各 层 的 功能 表示 如 下 : 
第 一 层 : 输入 层 
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输入 层 的 各 个 节 避 直 接 芒 输入 基 的 各 个 分 其 连接 ， 将 输入 量 传 到 下 一 层 。 对 该 层 的 每 个 
节点 的 输入 输出 表示 为 ; 
下 = 是 二 [ao (4.76) 
第 一 导 ， 核 糊 化 层 
采用 高 斯 钳 基 煞 作为 隶属 吨 数 ，cy 和 已 分 别 是 第 ; 个 输入 变量 第 了 个 模糊 集合 的 隶属 二 
数 的 均值 和 标准 羌 。 
人 一 人 2 
oren|- | 《4.77) 
他 bp 


it 1 2 12， 






模糊 推理 层 通 过 与 模糊 化 层 的 连接 来 完成 模糊 规则 的 下 配 ， 各 个 节点 之 加 实现 模糊 运 





算 ， 即 通过 各 个 模糊 节 民 的 组 合 得 到 相应 
人 号 的 科 积 ， 即 : 





点 火 强度 。 每 个 节点 的 输出 为 该 节点 所 有 输入 
办 
AD=1TAGC 《4.78) 


zf, N=TIx 


第 四 层 : 输出 层 
输出 层 输 出 万 为 入, 帮 , 姑 整定 结果 ， 该 层 册 一 个 节点 构成 ， 即 : 


上 














POD=mw 太 =DnC 让 态 人 (479) 
式 中 ，wy 组 成 输出 节点 与 第 一 层 各 节点 的 连接 权 拢 隆 :=1, 2.3。 
控制 器 为 ， 
Ar(K)= 六.Xc= KxXc(]) 十 克 XC(2) 十 KaXCK3) 【4.80)》 
其 由 ， 


六 = 态 (， 大 = 大 2)， 避 = 大 (3) 

Xe 上 =e(K) 

xc(C)=e( 扣 一 e( 类 一] 

xc(3)=Ae(O=e(-2e(k-D+eK-2) 
采用 增 量 式 PlD 拼 制 算法 : 





有 =wCk-D+Ax( (4.81) 

采用 Delta 学 习 规则 来 修正 可 调 参数 ， 定 义 昌 标 冰 煞 为 ; 
-了 Gin(D -youtOP (4.82) 
式 中 ，rinG) 和 yout(k) 分 别 表 示 网 络 的 实际 和 输出 和 理 塌 输出 ， 每 “个 选 代步 骤 大 的 控制 误差 


为 rin( 吕 -yout(K) 网 络 权 值 的 学 习 算 法 如 下 : 











0 1 Byout 9An 
Am (= -一 人 (En( 昌 -yout()， 2 党 
1 (4.83) 
-Gin(- yout(D) 33oatxe( 用 万 ( 有 
axx 
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式 中 ，w) 为 网 络 输出 节 闷 与 荆 一 层 各 节点 的 连接 权 ， 了 =1 2,…, 六 ， 了 为 学 习 速 率 。 
车 考虑 动量 肉 季 ， 则 输出 层 的 权 值 为 ; 
间 ( 间 = 同化 -D+Aw(D+aGwi 人 -TD 一 mw 全 -2 (4.84) 
式 中 , 上 为 网 络 的 选 代步 孤 ，w 为 学 习 动 励 因子。 


4.8.2 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为 : 














一 0.1y( 一 贡 +H 开 一切 

1+ YY 大 一 2 

仿真 中 ， 网 络 的 输入 们 号 为 两 个 ， 即 指令 信号 和 对 象 的 实际 输出 ， 针 对 每 个 输入 取 5 个 
模糊 集 进行 模糊 化 ， 即 mn =2,N=5， 网 络 结构 取 2-5-5-3 的 形式 ， 网 络 学 习 参 数 取 
习 =0.20，w =0.02 。 网 络 的 初始 权 值 及 隶 属 未 数 参 数 初 值 通过 试验 得 和 到。 仿真 结果 如 图 4.40 
和 图 4.41 所 示 。 


了 ( 阳 一 





rin,yout 








04 05 

















02 timets) 03 
图 4-40 阶 跃 响应 
0 一 一 -一 一 - 
呈 -0.2- | - 
0.4 一 一 一 -一 一 一 一 -一 
0 0.1 0.2 0.3 0.4 0.5 
05- 一 一 - - - - 1 
人 
罗 | 
王 
0 - 一 - - -一 一 - 
1 01 0.2 0.3 0.4 _ 05 
1 
及 0.5 1 
0 一 - 一 一 一 一 二 
0 0.1 0.2 0.3 0.4 0.5 


timetfs) 
图 4-41 PID 的 整定 过 程 
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仿真 程序 :chap4_10.m。 
aadaptive PTD control baseq cn Fuzzy RRFP Tdentification 
clear all11 


close all1; 


xite=0.207 
alfa=0.021 


c0=0.-65*onest2，5) 7 

bo0=0-20x*omesiS, 1) 

w0=[0.5632 .2136 口 .5049 
口 , 53 了 -0.5065 -7017 
-0,.7906 .8598 D.3318 
-0.3420 -1401 -0.5261 
-0.4778 -0.9920 站 .455 了 
-0D.2232 .8098 -0.4829 


曲 .7947 0.9565 -0.0610 
站 .533 白 0.3156 D.-7150 
-0.511 台 牛 -453 引 0.6668 


-0.0907 -0.0227 -0.0480 
.6553 0.3716 -0.3197 
-0.153 昌 -0.2741 中 .0844 
0.3980 虽 .1980 0-.1230 
卫 .5349 D.0287 0.8504 
D.6509 -0.9090 -9.4512 
-0.1935 0D.9827 -0.4087 
D.3032 -0.3808 吕 .2251 
-0.6951 -0.4871 吕 .7813 
-0.3202 0-2202 D.4289 
-0.96]4 -0.1060 -0.25970 
吕 .53656 -1631 -9.7837 
-全 .0842 -0D-1763 D.4761 
-0.914298 口 .4281 0.5240 
-0.8009 -0.7944 -0.4420 
0.9138 -0.2397 0.6904]: 
SwO=rands (25 3) 了 


c=eoirc_1-c0ic_2-c0; 
pb=b0;b_]=b0;b_2=b0: 
WwWa=w0iw4 1=w0)w4_2=wD7 


x=[9,0] 
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XxC= [ODS 7 


au_L=0;uU_ 1=0;Y_1=0; 


erTOL_1=n7error_2=0ierror=01 





七 ime (K) =Kxf 吕 7 
inmtk)=T.9z 
YeutIkl=ft-0.z*y_1+u_1L17 (1L+Y 2) 8%Nonlincear Plant 


xt1L)=rinfk)y 


XI2)=yout (ix): 


了 1=xy 
各 各 融和 和 和 对 和 玉生 入 和 各 秆 当 和 守 千 和 知 各 千村 守 仙 和 全 守 守 千 介 革 锡 于 和 守 和 和 和 和 和 和 委 针 和 和 千 于 和 和 和 
for i=1:1:2 & Layer2:fuzzation 
for j=1:1:5 
net2(ij)=-(Efl(ti)-c_tii)^27b_10)^2; 
enq 
ena 


for 1=1:1:2 





end 
第 千 甸 多 省 镍 务 省 范 委 先知 省 藻 千 车 务 咎 省 竺 和 备 禾 委 各 第 秆 和 久生 向 知 备 各 务 于 井 千 党 届 入 区 于 省 千 千村 千 秆 天 名 备 宙 才 
for J=1:1:5 8 Layer3:fuzzy inferencet49 rules) 
ml 1j) =fE2 (1 了 ) 
m21j)=f2(2，) 7 





ena 
or 工 = 荆 : 工 :5 
for j=1:1:5 





于 3 (了 了) =m2 人 IT) xml1t) 7 
end 
end 
fE3=[ff3(1,:) ,ff3(2,:) ,ff3(3，:)，Ef3(4，:) ff3(5，:1]， 
全 条 入 时 和 乞 东 车 多 务 甸 负 和 和 季 思 名 千 务 史 名 名 驹 务 千 各 生活 和 千 革 和 务 邦和 省 千 千 呈 生生 和 各 各 委 秆 千 委 生生 种 务 和 各 


上 4=w4'xE3 7 $ Layer4:ouEDUL 
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YXDP(K)=fTd4(I) 1 





ji) =f4(21 1 
ka(k) =fda(3) 
和- -Caliculate error id between yout and smout 





ETOF (KJ=zinT[K) -YOUDL (K) 7 


Gul(k)]=kp(k)sxct1)+kdtk)wxct2)+XLTIK)xXGC13) 1 
+Gutfk) 





Gyutk)=signf(yout (k)-y_1)7tautk) -dua_t+0-0001))7 


G_w4=0xw4_1) 
for i-1:1:25 
for :3-1:1:3 
QL_wafi yj)=xitexerrortkjydyutk)*xctj)x3() 
end 
enaq 
4=w4_1+ 口 wd+alfaxrfw4_1L-w4 _ 2) 


多 Returmn cf ParameterS 
au_l=autk) 
u_IL=utk): 
Y_1=Yyout {K) 


WwWd4_2=w4_17w4 1=w4; 


xc (1)=erroriKk)-error_17 &$Calculating 己 
XC{2)=error (kx] 7 SCalculating 工 
xc (3)=erTOF (k) -2+error_1+errOr_27 S$%Calculating 了 


error_2=error_l; 


etror_YT=error [K) 7 


en 

figure(1) 

Bloet time,rin，rb' timeyout， 7 
xlabel('timets) ) ;Yiabelf rinyout 7 
下 SUFet2) 


subplot (311) 1 
plot {EimeyXp, er 7 
xlabel(t'time(sl') yylabelf kP ) 
subplot(t312) 
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Bio5 timey ki rz) 7 


xlabelt'timets)') ylabelf('k 


subPlotit313) 7 
BlLot ttimeykd， rr 


xXLabelt t ' 芝 ime( 包 ) ) 7 YLahbel 


ii， 


] 


(kkG 
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第 5$ 章 基于 遗传 算法 整定 的 PID 控制 


5.1 录 传 算法 的 基本 原理 


遗传 算法 简称 GA 〈Genetic Algorithms) 是 1962 年 由 美国 Michigan 大 学 的 Holland 教授 
提出 的 模拟 白 然 反 遗传 机 制 和 生物 进化 沦 而 成 的 -种 并 行 随机 搜索 最 优化 方法 。 它 将 “优胜 
劣 汰 ， 适 者 牛 在 ”的 牛 物 进 化 原理 引入 优化 参数 形成 的 编码 串联 群体 中 ， 按 所 选择 的 适 配 值 
商 数 并 通过 遗传 中 的 复制 、 交 叉 及 变异 对 个 体 进行 病 选 ， 使 适 配 值 高 的 个 体 被 保留 下 来 ， 组 
成 新 的 群体 ， 新 的 群体 既 继 头 了 上 - 代 的 信息 ， 义 优 于 .上 一 代 。 这 样 周 而 复 始 ， 群 体 中 个 体 
适应 度 不 断 提高 ， 吉 到 满足 - - 定 的 条 件 。 其 算法 简单 ， 可 并 行 处 理 ， 能 得 到 全 局 最 优 解 。 

遗传 算法 的 主要 特点 : 

(1)》 遗传 算法 是 对 参数 的 编码 进行 操作 ， 而 非 对 参数 本 身 ， 

(2) 遗传 算法 是 从 许多 点 开始 并 行 返 作 ， 而 非 局 限于 一 点; 

(3) 遗传 算法 通过 日 标 函 数 来 计算 适 配 值 ， 而 不 需要 其 他 推导 ， 从 而 对 问题 的 依赖 性 较 





小 : 

(4) 遗传 算法 的 寻 优 规 则 是 由 概率 决定 的 ， 而 非 傅 定 性 的 ; 

(5) 遗传 算法 在 解 空间 进行 高 效 府 发 式 搜索 ， 而 非 言明 地 穷 举 或 完全 随机 搜索 ， 

(6) 遗传 算法 对 于 待 续 优 的 冰 数 基本 无 限制 ， 它 既 不 要 求 函数 连续 , 也 不 要 求 函数 可 微 ， 
既 可 以 是 数学 解析 式 所 表示 的 显 函 数 ， 又 可 以 是 喘 射 矩阵 甚 全 是 神经 网 络 的 隐 函 数 ， 因 而 应 
用 范 围 较 广 ; 

《7) 遗传 算法 具有 并 行 计算 的 特点 ， 因 而 可 通过 大 规模 并 行 计算 来 提高 计算 速度 : 

(8) 遗传 算法 更 适合 大 规模 复杂 问题 的 优化 ; 

(9) 遗传 算法 计算 简单 ， 功 能 强 。 

遗传 算法 的 基本 操作 如 下 。 

(1) 复制 Reproduction Operator)。 复 制 是 从 一 个 旧 种 群 中 选择 生命 力 强 的 个 体位 串 产 
牛 新 种 群 的 过 程 。 根 据 位 串 的 适 配 值 复制 ， 也 就 是 指 具 有 高 适 配 值 的 位 串 更 有 可 能 在 下 一 代 
中 产 牛 - -个 或 多 个 子孙 。 它 模仿 了 自然 现象 ， 应 用 了 达尔 文 的 适 者 生存 理论 。 复制 操作 可 以 
通过 随机 方法 来 实现 . 苦 用 计算 机 程序 来 实现 ,可 考虑 首先 产生 0 一 1 之 间 均 匀 分 布 的 随机 数 ， 
车 某 串 的 复制 概率 为 40%， 则 当 产 生 的 随机 数 在 0.40 一 1.0 之 间 时 ， 该 串 被 复制 ， 否 则 被 淘 
汰 。 此 外 ， 还 可 以 通过 计算 方法 实现 ， 其 中 较 典 型 的 几 种 方法 为 适应 度 比 例 法 、 期 望 值 法 、 
排 位 次 法 等 。 适 应 度 比例 法 较 党 用。 

(2) 交叉 〈Crossover Operator)。 复 制 操作 能 从 旧 种 群 中 选择 出 优秀 者 ， 但 不 能 创造 新 
的 染色 体 。 而 交叉 模拟 了 生物 进化 过 程 中 的 繁殖 现象 ， 通 过 两 个 染色 体 的 交换 组 合 ， 产 生 新 
的 优良 品种 。 它 的 过 程 为 ， 在 匹配 池 中 任 选 两 个 染色 体 ， 随 机 选择 一 点 或 多 点 交换 点 位 置 ; 
交换 双亲 染色 体 交 换 点 右边 的 部 分 ， 即 可 得 到 两 个 新 的 染色 体 数 字 捉 。 交 换 体现 了 自然 界 中 
信息 交换 的 思想 。 交叉 有 一 点 交叉 、 多 点 交叉 ， 还 有 一 敏 交 叉 、 顺 序 交 义 和 周 期 交叉 。- \ 点 
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交叉 是 最 基本 的 方法 ， 应 用 较 /。 它 是 指 染 色 体 切断 点 有 一 处 ， 例 : 

4:101100 1110 一 101100 0101 

五 :001010 0101 一 001010 1110 

03》 变 异 Mutation Operator).。 变 措 运算 用 来 模拟 生物 在 白 然 的 蝗 传 环境 中 由 于 各 种 偶 

然 因素 引起 的 基因 突变 ， 它 以 很 小 的 概率 随机 地 改 安 遗 代 基 因 《〈 到 示 染 色 体 的 符号 串 的 某 一 
位 》 的 值 。 在 染色 体 以 一 进 制 编码 的 系统 中 ， 它 随机 地 将 染色 体 的 某 -- 个 基因 由 上 变 为 0， 
或 出 0 变 为 1。 若 只 有 选择 和 交 义 ， 侧 没有 变异 ， 则 大 法 在 初始 基因 组 合 以 外 的 空间 进行 搜 
索 ， 使 进化 过 程 在 早期 就 陷入 局 部 解 谭 进入 终止 过 程 ， 从 而 影响 解 的 质量 。 为 了 在 尽 可 能 
的 空间 中 获得 质量 较 总 的 优化 解 ， 必 须 采 用 变 噶 操作 。 


5.2 ”遗传 算法 的 优化 设计 


























5.2.1 遗传 算法 的 攀 成 要 素 


《1) 染色 体 编码 方法 : 基本 遗传 算法 使 用 周 定 长 度 的 二 进 制 符号 来 表示 群体 中 的 个 体 ， 
其 等 位 基因 巾 二 值 符号 集 {0.1} 所 组 成 。 初 始 个 体 的 其 央 值 可 用 均匀 分 布 的 随机 值 米 后 成 , 如 ， 
x= 100111001000101101 就 可 表示 一 个 个 体 ， 访 个体 的 染色 体 长 度 a=18 。 
《2) 个 体 适 应 度 评 价 ， 基 本 咀 传 算法 与 个 体 适 应 度 成 正比 的 概率 决定 当前 群体 中 每 个 个 
体 遗 传 到 下 - 代 群 体 中 的 概率 多 少 。 为 正确 计算 这 个 概率 ， 要 求 所 有 个 体 的 适应 度 必 须 为 正 
数 或 肥 ， 因 此 ， 必 须 先 确定 由 目标 函数 值 到 个 体 适 应 度 之 间 的 转换 规则 。 

(3) 遗传 算 季 基本 遗传 算法 使 用 下 述 三 种 遗传 算 子 ， 

全 选择 运算 使 用 比例 选择 算 子 ; 

@@ 交叉 运算 使 用 单 点 交叉 算 子 ; 

图 变异 运算 使 用 基本 位 变异 筑 了 或 均匀 变异 算 子 。 

(4》 基 本 遗传 算法 的 运行 参数 ， 有 上 下 述 4 个 运行 参数 需要 提前 设 定 : 
:; 群体 大 小 ， 即 群体 中 所 含 个 体 的 数量 ，“” 般 取 为 20 一 100， 
遗传 算法 的 终止 进化 代数 ， 一 般 取 为 100 一 500; 
交叉 概率 ， 一 般 取 为 0.49 一 0.99; 
:变异 概率 ， 一 般 取 为 00001 一 0.1:,。 





























全 


5.2.2 站 传 算法 的 应 用 步骤 





对 于 “' 个 需要 进行 优化 的 实际 疾 题 ，- 般 可 按 下 述 步 又 构造 遗传 算法 : 

第 --- 步 :确定 决策 变量 及 各 种 约束 条 件 ， 即 确定 出 个 体 的 表现 型 X 和 问题 的 解 空间 。 

第 一 步 ， 建 立 优化 模型 ， 即 依 定 出 日 标 通 数 的 类 型 及 数学 描述 形式 或 量化 方法 。 

第 三 步 ， 确 定 表示 可 行 解 的 染色 体 编码 方法 ， 即 确定 出 个 体 的 基因 型 x 及 遗传 算法 的 搜 
索 空间 。 

第 四 步 ; 确定 解码 方法 ， 即 确定 出 由 个 体 基因 型 x 钊 个体 表现 型 和 的 对 应 关系 或 转换 方 























法 。 





第 五 步 : 确定 个 体 适 应 度 的 量化 评价 方法 ， 即 确定 出 出 日 标 函 数值 7 到 个 体 适 应 度 函 
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数 F(z) 的 转换 规则 ， 

第 六 步 : 设计 遗传 算 子 ， 即 确定 选 搓 运 算 、 交 叉 运 算 、 变 异 运算 等 遗传 算 子 的 具体 操作 
方法 ， 
第 七 步 ; 确定 遗传 算法 的 有 关 运 行 参数 ， 即 MG 忆 . 只 等 参数 。 


5.3 ”遗传 算法 求 函 数 极 大 值 


利用 遗传 算法 求 Rosenbrock 函数 的 极 大 伍 : 
上 瑟 2 二 (0 
2.048 < 所 2.048 G=12) 
该 函数 有 两 个 局 部 极 大 点 ， 分 别 是 (2.048,-2.048) = 3897.7342 和 -2.048,-2.048) = 
3905.9262， 其 中 后 音 为 全 局 最 人 点 。 


5.3.1 二 进 制 编码 遗传 算法 求 邓 数 极 大 值 


求解 该 问题 遗传 算法 的 构造 过 程 : 

《1)》 确定 决策 变量 和 约束 条 件 ， 

(2 建立 优化 模型 ; 

(3) 确定 编码 方法 : 用 长 度 为 10 位 的 二 进 制 编码 串 分 别 表 示 跑 个 决策 变量 当 ,xza 。10 位 
二 进 制 编码 串 可 以 故 示 从 0 一 1023 之 间 的 1024 个 不 同 的 数 ， 帮 将 六 , 妈 的 定义 域 离散 化 为 

1023 个 均等 的 区 域 ， 包 括 两 个 端点 在 内 具有 1024 个 不 同 的 离 获 点 。 从 离散 点 -2.048 到 离散 
点 2.048 ， 依 次 让 它们 分 别 对 应 于 从 0000000000(0) 一 111111111101023) 之 问 的 二 进 制 编码 。 
鞭 将 分 别 表示 ,z 的 两 个 10 位 长 的 二 进 制 编码 串 连接 在 一 起 ,组 成 一 个 20 位 长 的 二 进 制 编 
码 串 ， 就 构成 了 这 个 函数 优化 问题 的 染色 体 编码 方法 。 使 用 这 种 编码 方法 ， 解 空间 和 遗传 算 
法 的 搜索 空间 就 具有 - -- .对 应 的 关系 。 例 如 ，x:0000110111 1101110001 就 表示 一 个 个 体 的 
基因 型 ， 其 中 前 10 位 表示 为 ， 后 10 位 表示 妃 。 

(4) 确定 解码 方法 ， 解 码 时 需要 将 20 位 长 的 二 进 制 编 玛 串 切 断 为 两 个 10 位 长 的 二 进 制 
编码 串 ， 然 后 分 别 将 它们 转换 为 对 应 的 十 进 制 整数 代码 ， 分 别 记 为 六 和 六。 依据 个 体 编码 方 
法 和 对 定义 域 的 离散 化 方法 可 知 ， 将 代码 y 转换 为 变量 丘 的 解码 公式 为 : 

所 =4096x-2- -2.048  CG=12) 《5.1) 
1023 


例如 ， 对 个 体 x:0000110111 1101110001 ， 它 由 两 个 代码 组 成 ; 

入 二 55，) =881 
上 述 西 个 代码 经 过 解码 后 ， 可 得 到 两 个 实际 的 值 : 

冯 = 一 1.828， .=1.476 
《5》 确定 个 体 评价 方法 : 由 于 Rosenbrock 函数 的 值 域 总 是 非 负 的 ， 并 且 优 化 目标 是 求 函 
数 的 最 大 值 ， 故 可 将 个 体 的 适应 度 直接 取 为 对 应 的 已 标 函数 值 ， 即 ; 

下 ( 妇 = 7Cxhxz) 《5.2) 

选 个 体 适 应 度 的 倒数 作为 日 杯 函 数 : 
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1 
/DEF 15.3) 


〈6) 设计 遗传 算 子 : 选择 运算 使 用 比例 选择 算 了 ， 交 义 运 算 使 用 单 点 交叉 算 子 ， 变 并 运 
算 使 用 基本 位 变 措 算 子 。 

(7)》 确定 遗传 算法 的 运行 参数 : 寿 体 人 小 于 =80.， 终 卜 进化 代数 G=100 ， 交 叉 概率 
书 =0.60 ， 变 异 概率 已 =0.10。 

王 述 7 个 步骤 构成 用 于 求 Rosenbrock 函 数 慨 大 但 优化 计算 的 一 进 制 编码 遗传 算法 。 

采用 上 述 方法 进行 仿真 ， 经 过 100 步 选 代 ， 最 佳 样本 为 ; 





Besty=[00000000000000000000] 


好 当局 =-2.0480, xz = 一 2.0480 时 ， Rosenbrock 函数 具有 极 大 值 ， 极 人 值 为 3905.9 。 
在 遗传 算法 的 优化 过 程 中 ， 目 标 函数 了 和 适 点 度 函 数 尺 的 变化 过 程 如 图 5-1 和 网 5-2 所 


示 ， 由 仿真 结果 可 知 ， 随 着 进化 过 程 的 进行 ， 和 群体 中 适应 度 较 低 的 “ 些 个 体 被 逐渐 淘汰 ， 而 
适应 度 较 高 的 一 些 个 体会 越 来 越 多 ， 并 旦 它们 都 集中 在 所 求 问题 的 最 优点 附近 ， 从 而 搜索 刘 


问题 的 最 优 解 ， 


Best J 


Best F 


X 104 











”20 40 60 80 100 
Tine(s) 


疼 5-1 日 标 数 了 的 优化 过 程 














3800 
3600 
3400 
3200L - - 二 
0 20 40 60 80 100 
time (s) 


图 5-2 ”适应 度 函 数 五 的 优化 过 程 
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5.3.2 ”仿真 程序 


仿真 程序 ，chap5_lm。 
8Generic ALgorithm for function fxl,x2) optimum 
clear alli 


Close all7 


多 Parameters 
Size-80: 
G=100; 
CodeL=107 


Umax=2.-048: 
umin=-2.048: 


E=roundatranatSizey 2*coaeb)) 1; SITnitial Coqe 
&%Main Prograrm 
or k=1:13:9 


上 ime [K) = 


for 8S= 呈 1 ze 





m=E(S，: 
YL=07Y2=07 


%Uncodaing 
ml-mt1:1:CodeL) 





for 1i=131:CodeL 
Y1=Yy1+ml(ti)*2^ 人 (1) 1 
endq 


xl1= (umax-umin)*y171023+urminy 
m2=mtCodqeL+1:1:2*CodeL) 7 





for 1= :CodeL 
Y2=y2+m2 (1)*2、(i-1L) 
end 


x2= (umax-uminjwy271023+uminy 


FIS)=100x(X1^2-X2)^2+ (了 -X11 27 


enmaq 


JI=1.AEF7 
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锁 炎 克 交 才 克 克 站 让 GD 二 : 了 valuate BeSfJ 本 让 寺 让 本 二 


BestJ fk)=minlJi) 7 


荆 =F7 多 FitnesSs FERnctioen 
LodaerEi,Inaqexfti]=sortIEily Sarrancing fi smal7> to Diggcr 
Besttfi=Odqerfi(Size) DeL BestEi=maxlfi) 


BesLS=E{tImnQexfi (Size)， %Lef BestSs=Etml Im iTS the InQexEI 





max 【) 


IDfitky=Bestfiy 


机 kwsyw 有 SGLED 2 : Select ang Reproduct OPerationy www 
fi_surm=surm(Ei) 


fi_size=(oaerfi/fi_sum)*sizey 








fi_S=floortfi_Size) &Selecting BigGer fi value 
kk=17 
for i-1:1:Size 
for j=1:1:fi_sti) #Select and Reproduce 
TempBIkk, :) -BtIndextifi)，:)5 
kk=kk+17 gskk is used to reproduce 
enad 


en 全 


入 放大 二 文才 本 三 认 业 二 窟 LeD 3 : CEOBSOVeIT OPeLRLiOD 让 相让 相让 
Dec=0.601 


mm=ceil(20*TanQ) 17 





for ji=1:2x:(Size-1) 
temp=randly 
E Pc>temp 8Crossover Condizion 
for j=n:t:20 
TempE ti， 





Eti+rl jj) 7 
TempEti+l,jl=Blti,j)z 
end 
end 
end 
TermpE(Size, :)=BestS 
E=TempEi 
生生 ww SEED 和: Mbabionm OPerat QT 办 可 类 二 几 可 本 
pm=0.001; 
apm=0.001-t1:1:Sizel*(0.001) /Size; %Bigger fi，smaller Pm 


Pelong =e 
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和 多 Pr=Q.D7 虽 MO REaE 了 CO 


pm=0.17 8Hizg mutacion 


Size 





:2*coqeT, 
上 emp=Irana， 
FE pm>temp 8Mutation ConGition 


计 TYTemp 了 (ti， 





TempE (ji jy=1， 
else 
TempE(i ,jy=07 
endq 
ena 
eng 


EnDQ 


8Guarantee TempPop(30,:) is the code belong to the best inaividualtmax(fi)) 
TempE{6ize, :=BestS7 
下 =TempE; 


号 DO 


Max_Value=Bestfi 

BesLS 

xl 

xx2 

Eigure(1L) 7 

plot Itime,Best3) 
xlabelf'Times');ylabel('Best JJ' 1; 
figuref2) 7 

Plot (time,bfi)7 
X1lahbel('times')yy1label('Best 王 ' 7 


5.3.3 实数 编码 遗传 算 法 求 函 数 极 大 值 


求解 该 问题 遗传 算法 的 构造 过 程 : 
(01) 确定 决策 变量 和 约束 条 件 ， 
(2) 建立 优化 模型 ; 
(3) 确定 编码 方法 : 用 2 个 实数 分 别 表示 两 个 决策 变量 冯 ,zm ， 分 别 将 为 , 妇 的 定义 域 离 
散 化 为 从 离散 点 -2.048 到 离散 点 2.048 的 Size 个 实数 。 
(4) 确定 个 体 评价 方法 : 个 体 的 适应 度 直接 取 为 对 应 的 日 标 冰 数 值 ， 即 
严 ( 轨 = Fo) 《35.4) 
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取 个 体 适 应 度 的 倒数 作为 目标 函数 
CO=-L- (55) 
下 (2 

《5) 设计 遗传 算 子 ， 选 择 运算 使 用 比例 选择 算 子 ， 交 叉 过 算 使 用 单 点 交叉 算 子 ， 变 民运 
算 使 用 基本 位 变异 算 子 。 

《6)》 确定 遗传 算法 的 运行 参数 ， 群 体 人 小 M =500 ， 终 止 进化 代数 G = 200 ， 交 叉 概率 
己 =0.90 . 采用 自 适 应 变异 概率 已 =0.10- [1:1:Size]x0.01/Size ， 即 变异 概率 与 适 访 度 有 关 ， 
适应 度 越 小 ， 变 异 概率 越 大 。 

上 述 六 个 步骤 构成 了 用 于 求 Rosenbrock 函数 极 大 值 的 优化 计算 的 实数 编码 遗传 算法 。 

采用 上 述 方法 进行 仿真 ， 经 过 200 步 欠 代 ， 最 佳 样本 为 

BestS = 三 2.0438 - 2.044] 

2.044 时 ， Rosenbrock 函数 具有 极 大 值 ， 极 人 值 为 3880.3 。 
遗传 算法 的 优化 过 程 中 日 标 函数 7 和 适应 度 函 数 环 的 变化 过 程 如 图 5-3 和 网 5-4 所 示 ， 
由 仿真 结果 可 知 ， 采 用 实数 编码 的 遗传 算法 搜索 效率 低 于 二 进 制 遗传 算法 。 


即 当 xz =-2.0438 ， xz = 一 








0 50 100 150 200 
time (s) 


图 5-3 日 标 通 数 了 的 优化 过 程 














50 100 150 200 
七 ime(s) 


图 5-4 适 频 度 函 数 忆 的 优化 过 程 
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5.3.4 仿真 程序 


仿真 程序 :chaps_2.m. 
8%Generiec al1gorithrm for function f(xl,x2) optimum 
clear 己 ]1 


Close all:; 


Size=S007 
CodeL=27 


MinX(L=-2.0487 
MaXxXI(I1L11=2.0481 
MinX (2)=-2.0487 
MaxXI2)=2.0481 


SnX(L)+(MaxXI1) -MinX(LI))x*rana(Size,1T) 





BE(:，3)=MIinX(2)+{MaxX{t2)7-MinXI2))*rana(Sizzey 1T) 7 


G-200， 
BsJ=0) 


可 二 二 放 才 赤 放 业 灾 才 妆 赤 才 才 帮 人 让 让 有 Ri 1 炎 克 二 表 二 炎 炎 二 二 放 
for kg=1:13:G 
上 ime (kg) KG 


黎 *。 炎 wwg BLEP 工 : EValuate 也 egH 可 交 炎 炎 才 光 光 


fo 








FF(i)=1L100* (xl1^2-X2)^2+(1-X1)>27 


Ji=1.7F7 


BsJi(L)=mintgi) 7 


[oae>Ji,inaexIi]l=scrt(BsJIi) 7 


BestJ(kg)=OdqerJit(1) 7 
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BI=BestIIkg) 


Ji=BSsJt+1e-10y %avoiding qQeviaing 过 ero 





[Oogerfi,TIndexfti]=sort(fi) 7 多 ATrTanging fi Small to bigger 
BeStfi=OqerfitSjzey 7 、 多 Det BeSstEi=maXx(E1L) 
BestS=EiIndexfi (Sizel,:); %Let BestS=B(Im)，m is the Indexfi belong to 


Tax (f 了 ) 


JPfi (kg)=Bestfir 


kg 
BesrS 

条 * 太 交 炎 ww ep 2 : Select and ReproGuct OPeratiOmr* 关 本 大 类 
于 i_Ssum=strmf ty) 


fi_Size=(Dderfiyfi_sum)*Sizer 


fi_S=Eloordfti_Size)7 % Selecting Bigger fi Value 


T=Size-Ssumidfi_S) 1 


Rest=fi_Size-ti_S7 


[RestValue, Index]=sort (Rest) 


于 or 庆 -Size:-13:8S1ze- 工 + 


fi_S(Inaex(i))=fi_Sf(InqextI) ) + 8 Rdding rest to equal Size 
ena 
K=1; 
for i=Size:-1:1 % Select the Sizeth and Reproduce firstly 





for j-1:1:fi_S(i) 





TermpE(k,:)= 忆 (Indexfiti)，:) 1 8 Select ana Reproduce 
k=k+l; $ K is used tc reproduce 
ena 
end 
秆 wwssywxswws BED 3 1 CragSOVer OPeratiaTl ww 办 类 wkw 才 克 
Pc=0.-90: 


for 1:2:(3ize-1) 


temp=ranQy 
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$Crossover Conaition 
忌 2fa=rand7y 


TempF 1 ， 





=alfax*E(i+l,:)+(1-a]fa)s*R(Iiv 





TemPE (ti+1，: 





一 吕 工 二 x 瑟 《 斌 ，) 十 (十 - 己 1 主 az 下 (T+ 1 
en 
enQq 


=RestSy 





Tenmpet 








E=TemPE; 


党 办 炎 灵 半 疼 文 业 炎 六 广 二 二 全 让 区 和 RUtaEiGn OPeTaLLOD ww 内 十 光 玫 二 本 克 直 二 赤 
FPm=0.10-[I:3:Sizel*tO.01)73izei7 SBigger fi,smal1ler Pm 
FEm_rane=ranctsizey CogdeL) 

Mean-1MaxX + MinXl 7 27 

Dif= (MaxX-MinX) 7 








Le 
for j= :1:CoQeL 
守 PPmCI) >Frm_ Yanaqti,) %Muration Conairjion 


TempPE1ti,j)=Meanijj+Dift3)*ftrand-0.5) 了 
End 
end 
ena 
8%GUarantee TexpE(Size:) belong to the beat indiviqual 


TempPE(Size, :1=BestS: 





卫 =Tempt; 
emQG 
BestrS 


Bestfi 
5iguref1) 


Dlotr ttimev BeszrJ，kKk') 7 


xlapellrTimes')yylabel('Rest J') 1 “ 
EiSuret23 1 


Blek ttimeyDEiT， KE 》 
xlabelt'rimes')7ylabelt "BesL 了 ) 1 


5.4 基于 遗传 算法 的 PID 整定 


BID 以 制 是 工业 过 程控 制 中 应 用 最 广 的 策略 之 一 ， 因 此 PID 控制 器 参数 的 优化 成 为 人 们 
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关注 的 问题 ， 它 直接 影响 控制 效果 的 好 坟 ， 半 和 系统 的 安全 、 经 济 运行 有 着 密 不 可 分 的 关系 。 
号 前 PID 参数 的 优化 方法 有 很 多 ， 如 间接 寻 优 法 ， 梯 度 法 ， 巾 山 法 等 ， 而 在 热 工 系统 中 单纯 
形 法 、 专 家 定 法 则 应 用 较 广 。 虽然 这 些 方法 玫 具 有 民 好 的 寻 优 特性 ， 但 存在 着 一 些 整 端 , 
单纯 形 法 对 初 针 比较 敏感 ， 容 易 陷 入 局 部 最 优化 解 ， 造 成 寻 优 失败 。 专 家 整定 法 则 带 要 太 多 
的 经 验 ， 不 同 的 日 杯 表 数 对 应 不 同 的 经 验 ， 而 整理 知识 库 则 是 一 项 长 时 间 的 工程 。 因 此 我 们 
选 职 了 遗 估算 法 来 进行 参数 好 优 ， 该 方法 是 -种 不 需要 任何 初始 信息 并 可 以 寻求 全 局 最 优 解 
的 、 癌 效 的 优化 组 合 方法 。 

采用 遗传 竺 法 进行 FID 一 个 系数 的 驿 定 ， 具 有 以 下 优点 : 

(1) 与 单纯 形 法 相 比 ， 遗 传 算法 问 样 具有 良好 的 子 优 特性 ， 且 它 克服 了 单纯 形 法 参数 初 
值 的 敏感 性 。 在 初始 条 件 选择 不 当 的 情况 下 ， 遗 传 算法 在 不 希 要 给 出 调节 器 初始 参数 的 情况 
下 ， 仍 能 子 找到 合适 的 参数 ， 使 控制 于 标 满足 要 求 。 同 时 单纯 形 法 难以 解决 多 值 秃 数 问题 以 
及 在 多 参数 好 优 (如 帅 级 系统 ) 中 ， 容 易 造成 寻 优 失 败 或 时 间 过 长 ， 而 遗传 算法 的 特性 决定 
了 它 能 很 好 地 克服 以 上 问题 。 

(2) 与 专家 是 法 相 比 ， 它 具有 操作 方便 、 速 度 快 的 优点 ， 不 需要 复杂 的 规则 ， 只 通过 
字 串 进行 简单 地 复制 、 交 义 、 变 异 ， 便 可 达到 寻 优 。 避 免 了 专家 整定 法 中 前 期 大 量 的 知识 库 
整理 工作 及 人 旦 的 仿真 实验 。 

(3) 遗传 算法 总 从 许多 点 开始 并 行 操作 ， 在 解 空间 进行 高 效 启发 式 搜索 ， 睁 服 了 从 单 点 
出 发 的 上 整 中 及 搜索 的 广 日 性 ， 从 而 使 寻 优 速度 更 快 ， 避 免 了 过 早 陷 入 局 部 最 优 解 。 

(4) 遗 估 算法 不 仪 适用 于 单 日 标 寻 优 ， 而 且 也 适用 于 多 目标 寻 优 。 根据 不 同 的 控制 系统 ， 
针对 一 个 或 多 个 日 杯 ， 道 传 算法 均 能 在 规定 的 范围 内 寻找 到 合适 参数 。 

遗传 算法 作为 - -种 全 局 优化 算法 ， 得 他 越 来 越 广泛 的 应 用 。 近 年 来 ， 遗 传 算法 在 控制 上 
的 应 用 日 益 增多 。 


























5.4.1 基于 遗传 算法 的 PID 整定 原理 


1, 参数 的 确定 及 表示 

首先 确定 参数 范围 ， 该 范围 一 般 是 由 用 户 给 定 的 ， 然 后 由 精度 的 要 求 ， 对 其 进行 编码 。 
选取 一 进 制 字 串 米 去 示 每 一 个 参数 ， 并 建立 与 参数 问 的 关系 。 再 把 二 进 制 串 连接 起 来 就 组 成 
一 个 长 的 一 进 制 字 串 ， 该 字 申 为 遗传 算法 呆 以 操作 的 对 象 。 








2. 选取 初始 种 群 

为 需要 编程 米 实时 各 过 程 , 所 以 采用 计算 机 随机 产 牛 初始 种 群 。 针对 二 进 制 编码 而 言 ， 
先 产 生 0 一 1 之 阅 均 匀 分 布 的 随机 数 ， 然 后 规定 产生 的 随机 数 0 一 0.5 之 间 代 表 0, 0.5 一 1 之 间 
代 友 1， 此外， 考虑 到 计算 的 复杂 程度 来 规定 种 群 的 大 小 。 














3. 适 配 函 数 的 确定 


一 般 的 好 优 方 法 在 约束 条 件 下 可 以 求 得 满足 条 件 的 一 组 参数 ， 在 设计 中 是 从 该 组 参数 中 
寻找 一 个 最 好 的 。 衡 量 一 个 控制 系统 的 指标 有 :个 方面 ， 即 稳定 性 、 准 箭 性 和 快速 性 。 而 上 
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升 时 间 反 册 了 系统 的 快速 性 ， 上 升 时 间 越 短 ， 控 制 进行 得 就 越 快 ， 系 统 品 质 也 就 越 好 。 

如 果 单 纯 妃 求 系统 的 动态 特性 ， 得 到 的 参数 很 可 能 使 控制 信号 过 大 ， 在 实际 应 用 中 会 央 
系统 中 同 有 的 饱和 特性 而 导 敏 系统 不 稳定 ， 为 了 防止 控制 能 量 过 大 ， 在 日 标 冰 数 中 加 入 控制 
量 。 因 此 为 了 使 控制 效果 更 好 ， 我 们 给 出 了 控制 量 、 误 益 和 上 升 时 间作 为 约束 条 件 。 因 为 适 
应 函数 同 目标 函数 相关 ， 所 以 目标 函数 确定 后 ， 直 接 将 其 作为 适 配 琢 数 进行 参数 寻 优 。 最 优 
的 控制 参数 也 就 是 在 满足 约束 条 件 下 使 F(9) 最 大 时 ，x 所 对 应 的 控制 器 参数 。 


和 








4. 遗传 算法 的 操作 

首先 利用 适应 度 比例 法 进行 复制 ， 即 通过 适 配 函 数 求 得 适 配 值 ， 进 而 求 每 个 串 对 应 的 复 
制 概率 。 复 制 概率 与 每 代 字 趾 的 个 数 的 滋 积 为 该 串 在 下 一 代 中 应 复制 的 个 数 。 复 制 概率 大 的 
在 下 一 代 中 将 有 较 多 的 子孙 ， 相 反 则 会 被 淘汰 。 。 

其 次 进行 单 点 交叉 , 交 义 概率 为 忆 。 从 复制 后 的 成 员 里 以 刀 的 概率 选取 字 串 组 成 匹配 池 ， 
而 后 对 匹配 池 的 成 员 随 机 匹配 ， 交 叉 的 位 置 也 是 随机 傅 定 的 。 

最 后 以 概率 已, 进行 变异 。 假 如 每 代 有 15 个 字 串 ， 每 个 字 串 12 位 ， 则 共有 15x12=180 
个 串 位 ， 期 望 的 变异 串 位 数 为 180x0.01= 2 位 ， 即 每 代 中 有 两 个 串 位 要 由 ! 变 为 0 或 由 0 
灾 为 上 




























































































初始 种 群 通过 复制 、 交 叉 攻 变异 得 到 了 新 一 代 种 群 ， 该 代 种 群 经 解码 后 代入 适 配 函 数 ， 
观察 是 徊 满 足 结束 条 件 ， 若 不 满足 ， 则 更 复 以 上 操作 ， 直 到 满足 为 止 。 
结束 条 件 由 具体 问题 所 定 ， 只 要 各 目标 参数 在 规定 范围 内 ， 则 终止 计算 。 
以 上 操作 过 程 可 以 用 网 5-5 来 表示 。 
参数 
-一 一 
编码 
了 
种 铬 1 “一 一 一 
了 
计算 适 配 值 
和 一杯 旺 种 铬 种群 2 
天 
闫 更 上 一 一 | 让 传 操作 
雪 莘 
种 群 2 
解码 
寻 优 结束 











图 5-5 ”遗传 算法 六 程 图 
利用 遗传 算法 优化 如 尖 : 司 的 具体 步骤 如 下 : 


《1)》 傅 定 每 个 参数 的 大 致 郊 围 和 编码 长 度 ， 进 行 编码 ; 
《2 随 本 产生 个 个 体 构 成 初始 种 群 PLD : 
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53)》 将 种 群 中 各 个 体 解 码 成 对 应 的 参数 值 ， 用 此 参数 求 代价 函 数 信 了 及 适应 了 数 值 / ， 


44》 应 用 复制 、 交 又 利 变 只 算 子 对 种 群 PtD) 进行 扣 作 ， 产 生 下 “ 代 种 寿 Pet+D， 
《5) 重复 步骤 (3) 和 〈4)， 直 至 参数 收敛 或 达到 蔬 定 的 指标 。 


5.4.2 基于 实数 编码 遗传 算法 的 PID 整定 


被 控 对 象 为 一 阶 传递 男 数 : 
400 
5 50s8 
采样 时 间 为 Ims， 输 入 指令 为 阶 跃 信号 。 
为 获取 满意 的 过 湾 过 程 动态 特性 ， 采 用 误差 绝对 值 时 间 积 分 性 能 指标 作为 参数 选择 的 最 
小 日 标 函 数 。 为 了 防止 控制 能 量 过 大 ， 在 目标 函数 中 加 入 控制 输入 的 平方 项 。 选 用 下 式 作为 
参数 选取 的 最 优 指标 : 


GCC = 








了 = 人 ovjlenl+ wa2(D)de+ mm (5.6) 
式 中 ，e(D) 为 系统 误差 ，x&(D 为 控制 器 输出 ， 因 为 上 天 时 间 ， wwavws 为 权 值 。 
为 了 避免 超 记 ， 采 用 了 惩罚 功能 ， 即 一 旦 产生 超 亩 ， 将 超 调 量 作为 最 优 指标 的 一 项 ， 此 
时 最 优 指 标 为 :; 
证 ey( 人 <0 了 = 上 ovnleol+ WOD+WaeyCD)dz+wa (5.7) 
式 中 ， 四 为 权 值 ， 日 wwiey(O=yD-yG-D,XD 为 被 拉 对 象 输出 。 
遗传 算法 中 使 用 的 样 木 个 数 为 30， 交 义 概率 和 变异 概率 分 别 为 ， 屎 = 0.9,Pu = 0.033 。 参 数 
三 的 取 值 范围 为 [0.201， 辣 ,4 的 取信 范围 为 0]， 取 wm =0.999, wm =000Lw =100w=20。 
采用 实数 编码 方式 ， 经 过 100 代 进 化 ， 获 得 的 优化 参数 如 下 : PID 整定 结果 为 
后 = 19.0823,ju = 0.2434. 大 = 0.0089， 性 能 指标 了 = 23.9936 。 代价 函 数 了 的 优化 过 程 和 采用 闲 
定 后 的 PID 控制 阶 跃 响应 如 图 5-6 和 图 5-7 所 示 。 











Best JJ 











20 如 人 8 100 
time xs) 


知 5-6 代价 函数 了 的 优化 过 程 
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14 





rin,yout 








0 002 004 006 008 01 
二 ime fs) 


图 57 整定 后 的 PID 阶 跃 响 应 


在 应 用 遗传 算法 时 ， 为 了 避免 参数 选取 范围 过 大 ， 可 以 先 按 经 验 选 取 一 组 参数 ， 然 后 在 
这 组 参数 的 周围 利用 遗传 算法 进行 设计 ， 从 而 大 大 减 小 初始 寻 优 的 谨 目 性 ， 节 约 计 算 量 。 

















5.4.3 仿真 程序 





主 程序 ，chap5_3.m。 

&Ga(Generic Agorithm) Erogram to optimize PID ParameterSs 
人 LeaL 王 ] 工 : 

close all; 


global rin yout timef 


Size= 





CodeL=31; 


MinX 1)=Zeros(E) 
MaxX 1)=20*ones11) 7 
MinX{f2)=zeros(I) 
MaxX(2)=1I.0xrones(1) 17 
MinX(3)=Zeros{f]l) 7 


MaxX1(3) -1 -0xores(1) 7 

KBpiQ{l:，, 1) =MinX(1L)+(MaxX(1) -MinX(1l))*randtSice, 1)7 
gpidl:,21=MinX(2)+(MaxX(2) -MinX(2))*randfSize 1) 
Kpiaf:,3)=MinX(3)+(MaXX(3)-MinX(3)) samndftSize, 1 
G=100; 


BSJ=0; 
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第 穴 只 二 二 业 广 责 炎 炎炎 让 灾 二 寺 启 蕊 本 上 上 上 有 QT 六 业 机 业 炎 于 二 二 由 二 放 炎 _ 


for kg-1:1:G 
time (kg)=kg; 

xxvwxx GEep 1 

for il1z1:8ize 


KPiai=KpPiati,:)7 


[KPidi,BsJ]l=chap5_3f(KPiaQivBsJ) > 





[oaerJi Index]=sort (SSsJi) 7 
BestJ(KkS) =Oderui(1) 1 
BJ=BestJ(kg) 


可 i=BBSJ+1Ie-ID7 


于 i=1 .ZIiy 
多 Crm=max(JI) 


名 于 1=Cm-Jiy 


[oqerfi,InaexEiT=sort(tEi)7 
Bestfi=odcrfilfSize)， 


BestS=KPpiadlIndexfilSize) ， 





FaX(Ei) 


kgS 
BJ 
BestS 
凶 wyxyxw Step 2 
Ei、_sum=surm (fi) 


fi_Size={Odqerfiyfi_ sum)*Size 


fi_S=floortfi_Size) 7 


=Size-sumtffi_S) 1; 


Rest=fi_size-fi_S; 


[RestValue, rnaexj=sort(Rest) 7 


for 1=Size:-1:S12ze-z+l 


shvoiding deviding 


EVaIuace 巨 eSEJ 二 二 二 让 让 放 


zero 


saArranging fi small to bigger 
&Let Bestfi=maxtfi) 


和 Let BestS=E(m)，m is the Inqexfi belong ta 


Select and Reproduct OPeratiOmwr 闪 wm 人 


多 Selecting Bigger fi value 
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fi_StTIndaexti) = 


LIPGeXITL)》 +17 和 aqaing rest 上 tD ecual Size 





车 Select Lhe 3Sjzerh ang Repreduce 革 irst1IY 


了 8 Select anq Reproduce 





区 k is usedq to Teprodquce 


多 交趾 省 由 炎 业 商 让 办 Le 3 5 CITOSSDVYer OPET 配 LTD 作 相 相 十 才 才 和 由 
Fc=0.307 
for ji=1:2:43:ze-1) 





LCmP=Iand 
IE PC>temDp 8&Crossover ConaGition 


alLfa=ranG; 





Tempe(tiy:)=alEaxKpidti+l,:)+(IT-alEfal*Kpia(Iv: 
TempE(i+rt,:)=alfarxpid(i,:)+(1-alfa)xKpiQ(i+T,， 3) 1 
enQq 
erd 
=BestS; 





TempE(Size, : 


KKpid=yempE” 


元 才 二 二 二 二 二 二 二 二 GEeB 1 MUEaLiLOnD OP 开办 烛 检 直 丰 本 均 机 直击 
Pm<0.10-[1:1:Sizel*(0.01)7Sizey SBiGSer 人 ,smaller Pm 
PEm_rand=rand(SizeycodeT) 1 

Mean= (MaxX + MinX)727 

DiE= (MaxX-MinX) 7 


for i=1:1:8jze 
for j=l1:1:CodeL 
让 Pmtil>FPm ranqt(i, 了 jy %Mutation ConaitIon 
TempE (ij)=Mean(j)+Diffjl*(ranG-0.5)7 
ena 
end 
emG 
SGuarantee TempE(Size, :) belong Fo the best inaividual 


BeRtS 





TempEtSize， 
长 Piad=TempE: 
enQ 


Bestfi 
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BestS 

Becast_J=BeetJ(G)》 

figureltl37 

Pzet {time,BestJ) 7 
xlabelf'T:mes')iylabelf'Best 可) 
FEigure(21 1 

BliorfLimefyrin， reimeE,yout，b' 7 


Xlabelft Timefs) ') 7YyJabelft zina,YOnt' ) 7 


子 程序 ，chapS 3f.m。 
funcrion [Kpidi,BsJ]=Dpiad_gaflKpiai,6sc) 


g1Lobal x1R Yout 下 ime 上 


ts=D.001: 
SYS=tErd400，[L ,50,0977 
gsys=c2Q1SYSES，Z ) 7 


[numvden]=tftaatatasys，v'): 


u_1=0.0ru_2=0.07 





Y-_1=0.0)Y-: 
x=[0,0,0]95 





fo k=13:]:P 
二 imeffk)=Kx*LS7 
rtkj=riny 


utxli-Kpiaitlyx*x(Li+KPpiaQil2)*x(2)+KPiadig3)*Xf3)7 


Lit utk)>=10 





UK) 
end 
iT utki<=-10 
uk)=-107 
enQ 


yout{k)=-den(2)x*y_1-daen(3)*y_2+numt2)x*u t+rnumt3) wD_ 2 
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error (K]=r1K) -YeuL(k) 

Rerurn of PID Parameters -----……------ 
u_2=u_1;u_1=ulk): 

Y_2=y_1;7_1=Youc (K) 7 





xt1)=erroc(kly 8 Calculating 
xf2)=terror(k)-errcr_l)/tsi 和 Calculating 了 
xt3)-x(3)+error(kjxtsi 外 Caleclaring 工 





1E yout{fk)>0.95&Ycut tk)<1TI.05 


上 imesrk) 7 








for i=1:1:P 
Ji il=o.999*abs(errorti))+0.01xu(ih^2*0-1 
b=B+JItI) 1 
E > 
erryli)=yout(ti)-youtti-1) 7 
iE ecry ti)<0 
B-=B+100*abs (erryti)): 
enmQ 
enq 
enad 


BeJ=B+O.2*LUt 了 07 
5.4.4 基于 二 进 制 编码 焉 传 算法 的 PID 整定 


被 摔 制 对 象 为 二 阶 传递 函数 : 

400 
Go 5 二 505 

采样 时 间 为 Ims， 输 入 指令 为 阶 跃 信号 。 

采用 二 进 制 编码 方式 ， 用 长 度 为 10 位 的 -- 进 制 编码 串 分 别 表示 三 个 决策 变量 操 , 厂 .ka 。 
最 优 指标 的 选取 同 十 进 制 编码 遗 传 算法 的 PID 整定 ,遗传 算法 中 使 用 的 样本 个 数 为 Size=30 ， 
交叉 概率 和 变异 概率 分 别 为 ， 已 =0.60, 忆 =0.001-[1:1:Size]x0.001Size 。 

参数 上 的 取 值 范围 为 20， 大 ,无 的 取 值 范围 为 [0.1]， wwzvmvnw 的 取 值 同 十 进 制 纺 
码 遗 传 算法 的 PID 整定 。 经 过 100 代 进 化 ， 获 得 的 优化 参数 如 下 : 
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最 优 个 体 为 BestS=[010110111111011000100010000100] 。PID 优化 参数 为 : 
如 = 16.1290,K = 0.2209k = 0.2209 ， 性 能 指标 了 = 24.9812 ， 整 定 过 程 中 代价 函数 了 的 变化 














如 图 $-8 所 示 。 采 用 整定 后 的 二 进 制 遗传 算法 优化 PID 阶 跃 响应 如 图 5-9 所 示 。 


25.72 一 . - 





25.718- 
25716 
25.714- 


25 712 


Best JJ 


25.71- 


25 708 - 











25.706 
0 80 100 
time () 


图 5-8 代价 郑 数 7 的 优化 过 程 








0D! _ -- 1 
0 0.02 0.04 0.06 0.08 0.1 
Timets) 


图 5-9 ”一 进 制 遗传 算法 优化 PID 阶 跃 响应 





5.4.5 ”仿真 程序 





主 程序 : chap5_4.m。 

SGRA(Generic AL1gorithm) Program to cptimize PararmeterSs cf PID 
clear alli 

close ally 


glebal rin yout timef 


G=1007 
8jize=307 
CoaeL=10: 


MinX (1)=zeros (1) 1 
MaxX (1)=20*onest1): 
MinXt2)=zeros{11)1 
MaxX(2)=1.0*ones{(1)， 
MnX13)=2ereos (1) 7 


MaxX1t3)=1.0rones(11): 


R=rounGtrand(Size ,3*coaeb)) 1; 香 Initial Coael 


BeJ=01; 


for kg-131:G 
time (kg)=kg; 


for sS=1:1:3S+ze 





m=EfS， 


Y1=0JY2=0:Y3=07 


ml=mtl:l:cCoaeL) 7 
for 1i=1:1:CodeD 
YL1=y1+ml(iyY2、 (Il1) 7 
end 
gpiats,1)=(MaxX(1y-MinXt1)) wy171023+MinXKt1) 7 


m2=rmtCedeL+1:1:2xCodeDL) 
foer 1i=1:1:CoGeL 
Y2=y2+m21i)*2^ti-1)1 
endQ 
Kpiats,2)={MaxX(2》-MinX(21) wy271023+MinX{t2) 1 





m3=mi2x*CodeL+1:1:3*CodeD) 
for ji=1:1:CodeL 

Y3=YyY3+m3 (IT)w2A(I-1) 
endq 


KDpiG(ts,3)={MaxX(3) -MinXf3)) xyY371023+MinX(3) 7 


条 kwy 炎 二 SFep 二 : 卫 Valuate 甩 eS 本 帮 光 庆 交 二 


FEpiqi=Kpiats:) 7 


iKpldi,BsJI]=chap5s_3f{(KPiIQi,BsJ) 了 
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BsJifts)=BSJ: 
is 


[oqerJi ,IndexJi]-sorc(BsJil 
BestJ(kg) =OqerJit1) 
BJ=BestJtkg] 

Ji=BSsJi+le-107 


开 = 工 -ZU7 
多 Crm=max (JIE) 7 
务 于 =Cm-Jiy; $%avoiding deviaing zerD 
[LOderfi, Indexfi]l=sort (fi) 8arrarging fi smalj to bigger 


第 Tet 忆 训 LE =InaX 人 TI1) 
，m is the [ndexfi belong 


g8 Bestfl=OoderfitSize)z 





#%LeL BestS3= 





s BestSs-=KpidlIndexfi(Size) ， 


to Iax(Ei)》 


争 Pet BeSsLEi=max( 人 ft) 


Bestfi=OderfitSize)7 
外 Let BesLS=Etm) ,misthe Indexfi belong omaxIfl) 


BestS=E(Inaexfi(Sizej，:) 7 


Xg 
BJ 
PestS; 


&xy++xw Step 2 : Select anG Reproduct OPeTaLiomwyryr 二 


于 _sum=surmt fi) 7 
上 1L_S1zeB= IOaerEiy7Ei_ sum * 台 ze 








fi _s=floor(fi_size)7 g%Selecting Bigger fi value 
Kk=17 
tor i=J:13:3Size 
for j=1:1:Efi Sti) Select and Reproduce 
TempE (dk, :) =E(Indexfiti)，:) 7 
kk=kk+13 &kk is used Fo reproduce 
ena 
ena 
种 二 才 二 省 炎 炎 业 后 [GD 了 :CTOSSOVeL OPeIBEiOIL 省 w 因 可 几 帮 相让 
pc=0.605 


mn=ceil123D*TranG) 1; 


for i=1:2:(S1ze-T) 
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蕊 emp=zanG; 
f Pc>temp &Crossover CondQition 
for j=n:1:20 
TempE(iL ,JJ)=E(+L，j) 7 
TempE(ti+1, 了)=E(I 了 ) 7 
end 
end 
enaQ 


TemPE(Size，: 





=BestS; 
E=TermpP; 


逢 www wy 六 二 玫 业 业 和 的 上 ED 有 MULak 了 On CD 并 Or 大 兴 光 灾 本 二 二 内 考 内 


&pm=D.003 

pm=0.001-[1:1:Sizel*(0.001)78Size; 8Bigger fi，smaller Pr 
更 Brm=D .OF 多 NO rnutaabionm 

spm=0.1; 。 $Big mucatiocn 


Er 1=1:1:S1ze 





for j-1:1:3*CodeL 
Eemp=zand; 
E pm>temp shMutation Conaition 


2 TempE ti, 





TempE (ij) = 





LS 所 
TempE ( 宇 ,) =07 
enQ 
endQ 
end 
enmQ 
SGuarantee empE(tSizcy :) belong to the best inaqiviaQual 


=BesES: 





TermPBE1ISize 
了 E=TermpE' 


十 六 业 妇 二 光 业 二 二 直 半 遇 二 二 汪汪 守 丰 和 光 夫 二 水 由 宙 闪 守 放 焕 机 直 间 只 村 大 焕 本 本 由 


eno 


Bestfi 

BestS 

KPiqiji 

Best_J=BestJ{G) 

figure(1) 7 

plot (time,BestJ) ; 
xlapel('Times')iylabel(t'Best JJ )) 
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figuret2)7 
BlLotftimeE rin rtirmeft yout， PP) 


Xlabelt'Tjimefs)')7y1abelf'rinyyout ' ) 7 
子 程序 : chap5_3fm《〈 同 前 )。 
5.4.6 基于 自 适 应 在 线 遗 传 算法 整定 的 PID 控制 


所 谓 在 线 PID 整定 ， 印 在 得 个 采样 时 间 分 别 对 PD 参数 进行 整定 。 采 用 遗传 算法 在 线 整 
定 PED， 就 是 针对 每 个 采样 时 间 实 贡 PID 控制 参数 的 遗传 算法 优化 。 在 采样 时 间 大， 选取 足 
够 多 的 个 体 ， 计 算 不 同 个 体 的 自 适 应 度 ， 通 过 遗传 算法 的 优化 ， 选 择 白 适 应 度 大 的 个 体 所 对 
应 的 PD 控制 参数 作为 该 采样 时 间 下 PD 的 控制 参数 。 
设 被 控 对 象 为 二 阶 传 递 函数 : 
400 
二 505 
采样 时 间 为 Ims， 输 入 指令 为 一 阶 跃 信号 。 
为 获取 满意 的 过 渡 过 程 动态 特性 ， 并 防止 产生 超 调 ， 采 用 误差 绝对 值 、 误 差 和 误差 变化 
率 的 加 权 及 作为 第 上 个 采样 时 间 时 第 守 个 个 体 的 参数 选择 最 小 目标 函数 。 
了 人 = as xlemori 人 + 8 xlde(l 《5.8) 
式 中 ，erroriG) 为 第 天 个 采样 时 间 第 个 个 体 的 位 置 跟踪 误差 ，de(D) 为 第 大 个 采样 时 间 第 守 个 
个 体 的 位 置 跟踪 误 闪 变化 率 。 
为 了 避免 超 调 ， 采 用 了 短 罚 功能 ， 即 一 旦 产生 超 调 ， 将 超 调 量 作为 最 优 指标 的 一 项 ， 此 
最 优 指标 为 : 


GCC) = 








也 


iferoriO<0 JGD=JyGODO+I00errori G| (5.9) 
针对 每 个 采样 时 间 进 行 PD 参数 的 遗传 算法 优化 。 在 仿真 程序 中 ，M=1 时 为 采用 遗传 算 
法 ， 否 则 为 本 整定 的 PID 控制 。 在 最 小 目标 函数 中 ， 取 om =0.95 ， 房 =0.05 。 遗 传 算法 中 使 
用 的 个 体 数 为 120， 进 化 代数 为 10 代 。 交 叉 概 率 为 已 =09， 采 用 自 适应 变异 概率 方法 ， 即 
自 
方 














适应 度 越 大 ， 变 异 概率 越 小 ， 变 异 概率 为 已 =0.20-[1:1:Size]x0.01Size 。 采 用 实数 编码 
式 ， 参 数 后 的 取 值 范围 为 B.012.0]，Ks 的 取 但 范围 为 了 .2.0.3] 。 

PD 的 阶 跃 响应 . PD 整定 过 程 中 控制 器 K 昌 的 变化 及 参数 大 、K 的 整定 过 程 如 网 5-10 一 
图 5-13 所 示 。 由 仿真 结果 可 见 ， 在 控制 的 初始 阶段 〈 误 差 小 于 0.50 时 ), 为 了 尽快 降低 误差， 
大 上 升 、Ka 下 降 : 当 上 升 到 一 定 程度 时 【误差 大 于 0.50 时 》， 为 了 防止 误差 变化 太 快 而 产生 
超 调 ， 恕 下降、K 上 升 ; 当 上 升 到 指令 值 而 产生 超 调 时 (t= 0.40s 时 )， 为 了 尽快 降低 误差 ， 
井上 升 、 如 下 降 。 

为 了 避免 参数 选取 范围 过 大 ， 先 按 经 验 选 取 一 组 大 、 开 参数， 然后 在 这 组 参数 的 周 


利用 遗传 算法 进行 设计 ， 从 而 减少 初始 寻 优 的 言 目 性 ， 节 省 计算 量 。 
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Timels) 
图 $-10 PD 整定 的 阶 暑 啊 应 
400 -一 一 一 一 一 
300 
200 
= 
100 
0 和 
-100 一 一 一 一 - -一 一 一 一 - - 
0 0.02 0.04 0.06 0.08 0.1 
Timets) 


kp change 


图 S-11 PD 整定 过 程 中 控制 器 x 昌 的 变化 





06 0.08 041 








0 0 0 


:04Tmeeia 


图 5-12 PD 整定 过 程 中 避 的 变化 












kd change 
吕 
包 


Timets) 
图 5-13 PD 整定 过 程 中 怠 的 变化 


5.4.7 仿真 程序 


仿真 程序 的 主 程序 ，chap5_5.m。 
8GatGeneric algorithm) to Optimize online PID Control 
clear ally 


CIoOSse 中 LT 


Size=1207 
CodaeL=2; 


MinX1{1)=9x*ones (1) ;MaxX(1)=12*ones(1) 7 
MinX {2)=0.20xonesf1) 7MaxXit2)=0.3D*ones(1) 


KPid(: ,1)=MinX(1)+(MaxX(L)-MinX(L) )*randa(Size1) 1 
Kpid(:,2) =MinX(2)+ (MaxX{t2)-MinX(2))*rand(Size,1): 


BsJ=D7 





X=Zeros(T ,2)7 
Xi=zZeros(1,2) 
XK=Zerog (1 2)1; 
ts=0.0017 


erTOT_ 1=01; 


BestS=zeros(2,1) 1 
for k=1:1:100 
七 iFme {K)] =K* 七 吕 ; 


0 
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Yintk) = 
SI(K=10xX(1)+O.2xX(2)7 %Test PI: good zxesultSs 


utk)=BestS(1]*xf1)+BestSl2)*X(2) 7 
Para=utk) 


t+SPan=[0O ts] 


[tt xx]=ode45('chap5_5E',tSpan,xk,[] ,Para) 了 
xk=xxtlength(xxl，:)7 
youttk)=xktl) 1 


erIorlk)=rinfk)-youtfIk) 7 
xf1)=error(kl S Calculating 日 


X{(2)=(errortfk)-error_ LAS7 多 Calculating D 


BTYOT_1=eITLTOC (K1 


B=07 


M=1: 8%Usjng GR 


E MK== 工 


G=10: 
for kg=13:13:G SEEra _ evolution 


荐 兴 才 放 二 二 避 丰 ED 工 3 EValuaLe 吾 忆 BE 可 三 下 玫 才 可 二 


for ii=1:1:31ze 


piadi=Kpid(i :7 
ui (i)=xpidi1l)*xfL)+Kpidi(2)xxf211 


Para=uiti); 
ftt ,xxi]l=oded51'chap5_5f' ,Span,xk, [] ,Paral] : 
Y(i=xxiftlengLh(xxi)v 1)7 


ereoriti)=rin(ki-y(iyi 
Gatiy=uiti) -utfk)z 
geti)=(erroriiti)-errortK))7LS 
alftap=0.951 





Petap=0O: 


iE apsterror(k))<=0.50 
lpetap=0.057 
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[1 


J=alfapx*abs(errori (i))+betaPx*abstaQetI)) 
B=J7 


E errorItii) < 
B=B+*100*absterrorIti))7 


enda 


BsJi (II)=B; 


[oaerui,IndexxJi]l=sort(BsJi) 

BescJ(kg) -oOderuit1)? 

BT=BestJ(kg) 

Ji=Bsditle-10; gaveiaing deviaing zero 


开 = ZT 
多 CI 一 maXxfTID) 
利 f=Cm-Jiy 


end End of a Sizellltllt II 


[oaderFEi,TInaexfi]=sort(ftiry arranging fi small to bigge 


Bestfi=odqerfitSize)7 &%Let BeSstfi=max{Ei) 


BestS-KpidfIindextitsizej,:); 8%Let BestS=E(m)，m isg the Inqexfi belong ro 


max (下 


虽 *ywww# Step 2 ; Select and Reproduct OPeTratiCTIN 于 让 二 
上 i_eum=sum fih 


fi_size=tOderfiyAft _Ssum) * 呈 izei 


Ei_S=floortTfi_Size): #_ Selecting Bigger fi value 


=Size-sum(fi_S)7 


Rest=fi_Size-fi_S: 


[RestVvalue, Index]=sort (Rest) 
Eor ii=8ize:-1:S12e- 工 + 了 


fi_S(Tnadexti))=fi_S(IndextI))+17 多 Rdding rest to equal Size 


em 
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fcr i=Size:-1i:1 & Select the Sizcth and Reproduce firstly 
for j=l:1:f_S(i) 





TempE tkr， KpiqQfInqexfifti)，:) 7 % Select and Reprodquce 
kr=kr+li & kr is used to reproquce 
end 
end 
等 w 二 才 由 证 十 炎 GEDP 3 : CrOSSOVeT OPDeTaLiDTL 考古 放 放 页 机 本 二 二 
Pc=0.90) 


for i=1:2:1(Size-1) 
emp=zanQ; 
if Pc>temp %Crossover Condition 


已 Ea=TamnQ 








TempE1tI， 已 Ja*KPiG{i+I，:)+(1-alEEa)*KPiQt，:) 
TermpE{fi+l,，:)=alfaxKpiQti,:)+(1-alEa)xKPiQti+l， 
em 
emaQ 
epE(Size，:)= 症 estS7 


Kpid=TempE 


各 本 灵 炎 和 炎 炎 雪 才 二 二 加 丰 人 让 三 JULBt On OPeTBE LO 二 二 主 二 本 才 丰 直 检 放风 





Pm=0.20-[1:1:9izelx(0.01)/Sizer $Bigger fi ,smaller Pm 
bm_rand=rand(SizevCodeL): 
Mean= (MaxX + MinX) 727 


Dif= (MaxX-MinX) 








for i=1:1:Size 
for ]=1:1:CodeL 
ibmti)>PrranQtfi,3) %Mutation Condition 


TempE ti, 了 )=Mean(tj)+Dif (3)*(zand-9.5) 
end 
ena 
end 


SGuarantee TempE(Size,:) belong to the best inaividual 





TempBtSize, :)=BestSy 
KPIid=TemPE; 


end 。%End of Kg 


jkphtk) =BestStI) 
kah(Kk)=BestSf12)7 
BestS 
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en %Ena cf M=1 


enaQ 8EBmnQ of K 


figure(1) 7 


DPlot (time,Trinoy rtime,your，D 7 


xlabelf'dimefs)' jyylabel('rin yout 17 
figurel2) 

Plot 人 Fime tl， IE ) 7 

X1labelf'Timefts)' )7Yylabelf ur li 
EM==1 


Figurel3) 

Blot (imevkph， Fr) 
xlapbel('zime(ts)'):Ylapelf'kp change' ) 了 
figuret4) 7 

Blot time,kdh， rr 

xlabel('Timelts)') ;ylLabel('kd change') 


ED 


被 控 对 象 子 程序 ，chap5_5fm。 


function Qx=PlantModqelitt,x,Eflag, para) 
ax=zerost23，1) 7 
=para 


QGxtL1=xt2) 1 
dx(2)--50*x(21+400*u7 


5.5 “基于 遗传 算法 摩擦 模型 参数 辨识 的 PID 控制 


5.5.1 瓣 识 原理 及 仿真 实例 


被 控 对 象 为 二 阶 传递 函数 : 


GO= 一 一 
= 5 


设 外 加 在 控制 路 输出 上 的 干扰 为 一 等 效 摩 斥 。 
当 扎 =1 时 为 库仑 摩 探 ， 摩 控 模 型 为 
斤 丰 =0.8sgnG(D 
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当 屎 =2 时 为 库 仓 摩擦 + 粘性 摩擦 ， 摩 控 模 型 为 : 
五 (= sgn(6COXelG| +ke) =sgn(6(DM0.306C|+1350) (5.11) 
式 中 ，kxl 和 kr? 为 待 辨识 参数 ， 
采样 时 间 为 Ims， 取 3=2 ， 使 输入 指令 为 阶 跃 信号。 
为 获取 满意 的 过 渡 过 程 动态 特性 ， 采 用 误差 绝对 值 时 间 积 分 性 能 指标 作为 参数 选择 的 最 
小 日 标 丙 数 。 为 了 防止 控制 能 莉 过 大 ， 在 目标 函数 中 加 入 控制 输入 的 平方 项 。 选 用 下 式 作为 
参数 选取 的 最 优 指标 : 

















/= Jeal +wa2(D)dr (5.12) 
式 中 ，e 人 9 为 系统 误 壮 ， 由 和 ww 为 权 值 。 
为 了 避免 超 调 ， 采 用 了 息 匠 功能 ， 即 一旦 产 牛 超 调 ， 将 超 调 量 作为 最 优 指标 的 … 项 ， 此 
时 最 优 指标 为 : 
ieD<0 = |wjeOl+waeO+meCobdr 《5.13》 


式 路 ，ws 为 权 值 ， 且 wwi。 
在 应 用 遗传 算法 时 ， 为 了 避免 参数 选取 范围 过 大 ， 可 以 先 按 经 验 选取 一 组 参数 ， 然 后 在 
这 组 参数 的 周围 利用 遗传 算法 进行 设计 ， 从 而 大 大 减 小 初始 寻 优 的 言 目 性 ， 节 约 计算 量 。 
采用 实数 编码 方式 ， 遗 传 算法 中 使 用 的 样 木 个 数 为 39， 交 叉 概 率 和 变异 概率 分 别 为 : 
忆 =09， 忆 =010-[l:1:Sizel]x00USize ，w = 0.999 ，w =0001，ws =10 。 
通过 取 kr = f0.0] 使 摩擦 补 偿 瑟 =0 ,得 到 在 无 摩擦 补偿 情况 下 的 扒 跃 响应 如 图 5-14 所 示 。 


1 --  - - 








0 005 01 0 02 025 03 035 04 
Tmetks) 


图 5-14 无 摩 氛 补 偿 的 阶 跃 响应 
取 已 =2 ， 运 行程 序 chap5_6.m， 采 用 遗传 算法 对 摩擦 模型 进行 辨识 。 待 辨识 参数 采用 实 
数 编码 法 ， 取 如 f = [0.3,1.51 ， 状 识 参数 io 和 心 , 的 范围 选 为 f0.2.0] ， 取 进化 代数 为 39。 经 过 
优化 获得 的 最 优 样 本 和 最 优 指标 为 : BestS =[0.3523,1.2257] ，Best_J = 25.5439 。 摩 擦 参 数 因 
识 结果 为 to =0.3523,jxs =1.2257 ， 采 用 摩擦 补偿 后 的 PID 控制 阶 跃 响应 如 图 5-15 所 示 ， 代 
价 函 数值 7 的 优化 过 程 如 图 5-16 所 泵 。 
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图 5-15 采用 摩擦 补偿 后 的 PLD 控制 阶 跃 明 应 


Best J 





255 一 -一 一 
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七 ime fs) 


图 5-16 代价 函数 值 了 的 优化 过 程 


5.5.2 仿真 程序 


主 程序 为 遗传 算法 程序 ， 子 程序 为 常 有 摩擦 异 型 的 PID 控制 程序 ， 

主 程序 : chap5_6.m。 

SGaIGeneric 六 LIgorithm)j Prograrm oo Predict Pararmetcre Of Friction 
Clear 忆 ]17 

Close all17 


globpal xrin yout 上 imef 中 


Size=307 

了 =27 

if F== 
CoaeT=17 
Minx=ZerostCodeL 1) 


MaxX=4 .0*onestCodeL ,1)7 
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enaQ 

工 E == 
CodeL=2: 
MinX=zeros (CoqdeL ,11}: 
MaxX=2.0*ones(CoqeL 1) 


enma 


for i=1:1:CoqepP 
kxit: vi)=MinX(i)+tMaxX(I) -MInX 人 IT) )xzandfSize 117 


enQ 


G=503 
BsJ=07 


for kg=1:1:G 
上 ime(KS) =Xg1 


千 * 六 说 炎 # 和 SeP :PEValuate 且 eBFO 攻 玫 玫 几 放 
for ii=1:1:81ize 
Kx=kxt fi 3)7 


[kx,BsJ] =chap5_6F (xx,BsJ) : 


BsJi ti)=BSJ7 


End 


[oaerIi, IndexJij=Sort{GsJi) 
BestJ(kg)=OderJi(1)1 
BJ=BestJ(K9) 7 

Ji=BsdJi+le-101 


三 i=1 .ZJir7 

虽 Cm=maxt(Jji) 7 

刍 王 i=Cm-Ji7 g%&vociding qeviqing zero 
[Oaerfi, IndextIl=sort(Eti) &%aLranging fi small ro bigger 
Bestfi=DOderfi(Size) : SDet BeSstEi=maxt 革 i) 


&Let BestS=EIm) ， 如 is the Inaexfi belong bo max(fih 
RestS=kxi(InqexfilSize)，:) 7 


kg 
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BI 
RestS 
Kx 

惠 xywywh SeDp 2 ;1 Select and Reproduct OPeraE1LOnrA As 
fi_surm=sumtfih， 


fi_Ssize=(odqerfiyfi_sum)*Sizey 


fi_S=floorfti_Size] 1 S$SelLect ing Bigger 于 Value 


=Size-sumtfi_S) 7 


Rest=fi_Size-ii_S 


[RestValue Index]=sorttRest)7 


for i=Size:-1:91ze-r+l 
fi_StIndexli))=fi_StIndex(ti))+l17 8%Rdding Test ro eSual Size 














end 
Kk=1; 
for 1i=Size:-131 Select the 8izeth and Reproquce First' 
for j=l:1:fi_S1i) SNotice: If i=1:1:Size then Kk Plus meaninglesSs 
TempE (K，: ) =JxitIndexfi ti)，:) 8%Select and Reproduce 
=K+13 $%K is used to reproduce 
ena 
end 
量 放 y 太 灵 才 炎 业 订 页 放 w 人 FED 3 1 CTOSSOVEL OPETRLOD 相让 
Ec=0.907 
for +=1:2:(Size-1) 
上 emp=zanQq:; 
了 瑟 > 上 er SCrossover Conaition 
站 fa=ranQGr 
TempB(i， :=alfa*kxiti+l， 3 )}+{ 工 -alTEa) xxXI(i，s ) 了 
mermpEti+1y:)=alfaxkxitiyi)+(1-alEal*kxititly 
ena 
end 
mempE (Size, :)=BestS7 


xji=TermpE 
sswtawt SEeP 4 MuEation OPeracion we 人 人生 
Em-=D.10-[13:13:8ize]l*(0-01) /Size 3Bigger fi，smaller Bm 
Pm_rand=ranatSize,CodeL): 
Meamn= (MaxxX + MinX) /721 
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Di= {Max 和 -MInX) 


for i=1:1:Size 
for j=i:1:CodeL 
if Pm(i)>Pm_ ranafj, 本 ) #Mutation Conditcion 


TempE (ijJ)=Mean(J)y+Dift]j)x(rana-0.5) 7 





emgQ 
eng 
ermd 
&%Guarantee TempE (Size,:) belong to the best jnqiviaual 
TermpE{tSize， esStS1 
kxi=TempE; 


第 训 认 放 认 夫 认 二 风 穴内 家 家 兴业 文本 雪 业 业 汪 冯 二 让 帮 丰 二 容 机 才 天 雪夫 次 认 实业 窗帘 认 赤 才 二 二 
enq 

Besft fi 

BestS 

Best_J=BestJ(G) 


figuref13 

DPlot (timef,riny'b' cimet,yout， Tri 
xlabelt'Time(s)')7Y1abelt rinyyout 7 
figuret23 7 

BLot (time,BestJ， 工 ') 
xlabelt'Times');ylabel4'Best 可 ') 7 


子 程序 : chap5_6fm。 
function [kx,BsJ]=pid_fm_ gaf(kx,BsJ) 
global Tin Yout 上 imef 下 


a=50;Db=400， 

ts=0.001; 

SYS=tftb, [1,a,0]) 7 
desys=c2q(sys,ts,'z07 


[num,den]=tfdataltdsys，V 1 


u_1=0;u_2=01; 





七 me 荆 { 芍 ) =Xw 上 SS 7 
S=27 
if 8 





Ere=57 
RPR=0.51 


Lin(K)=aA*Sint2xrPpixfreykrxte) 7 





em 名 

ES==2 
TELnIK 了 

end 


yout (kj >-aen(t2)*y_1-daen(3)YYy_2+num(2) *u_1+num(3)Ya 2 
erTOLr (kj)=rinmt(K) -Yout (K) 


derror (k) = (error(k)]-e_l)Atsy 


UKk)=50*errortk)+0.50rqerrocik) 7 


SPeeqiIk)= (yout (K)-Y_1) /ts 


if F--L 多 Disturbance Signal: Coulomb Friction 
FE{k)=0,.8*signtspeeditk)) 7 

endq 

让 F==2 多 Disturbance Signal: Coulomb & Viscous FTiction 
FE(k)=signtSpeediIk))*x(0.30*abs{tspeedQtk))+1.50) 7 


emQ 


名 kx= [0.0] SN GA TIqentification 
&kx= [0.3,1.5]，  %Idea IdaentficaLion 


utk)=utk) -FE(K) 7 


E F== 

FfC(K)=KxXySignfspeeG(K))  g%FTILCLicn Estimation 
eng 
IE F=: &%Friction Estimation 





FEfctk)=sicmtspeed(kK)l*tKkxtLi*abs(speed(K))+KX(2)) 7 


ena 


tk)=u(K)+PECIK) 


if utKk)>110 
Qufki=1107 
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enad 
iiE aftk)<-119 
utk)y=-L 107 


en 


U_a=U_I7IU_L=UTK) 7 





j)<C 昌 PUi hmenz 





B=B+IO*absferor il) 
em 
en 包 
BsJ=B7 
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大 全 


第 6 章 先进 PID 多 变量 控制 
6.1 _PID 多 变量 控制 


6.1.1 PID 控制 原理 


通过 PID 控制 ， 可 实现 多 变 旺 控制， 图 6-1 给 出 一 个 一 变量 PLD 控制 系统 框 赂 ， 该 系统 
由 两 个 PID 控制 器 构成 ， 控 制 算 法 为 : 
errofl -et -0D 局 空 erronG)7 
站 
ETOTI 大 ) 一 ITOT (天 一 ]) 
了 了 气 
式 中 ，7 为 采样 时 间 ，erron(k) = 1 人 一 以 CO) ，erropte)= 瑟 ( 拉 一 yo(k) 。 


ia( 虽 = 和 erron(t+R 


(6.1) 


下 
ia( 拉 = 2erronp (类 ) + Ko + 有 yerrop CT 








1 . 。 
-| DDI 上 | 























多 变量 一 
被 控 
攻 对 每 1 











入 - : 
一 G DD2z 广 一 一 | 














网 6-1 二 变量 PID 控制 系统 框图 


6.1.2 仿真 程序 及 分 析 


仿真 实例 
设 有 耦合 二 变量 看 合 被 控 对 象 
太 ( 拉 =1.0KL+ 员 开 -1D200.8mK -TD)+ 机 二- 仿 +0-22( 类 -3)) 
太 (人 J=1OUI+ 和 做 -TD)00.9y 估 -TD+030C 类 -3)+i( 类 -人 
设 采 样 时 间 了 = ls 。 给 定 输入 为 单位 阶 跃 输入 ， 即 


0 

疡 ( 拉 上 [LO 

ee 
mm) 11 
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当 输 入 指令 为 一 时 的 响应 曲线 如 图 6-2 所 示 ， 当 输入 指令 为 妨 时 的 响应 曲线 如 图 6-3 
所 示 ， 








人 500 1000 1500 
time(s) 


图 6-2 响应 曲线 ( 民 =[150])》 





站 500 timets) 1000 1500 


图 63 响应 曲线 (RR=[0:1]) 
仿真 程序 ，chap6_1.m。 


#PID Controller for coupling plant 
clear all' 


Close al]17 


ul_1=0.0:ul_2=0.0iul_3=0.0;ul_-4=0.07 
u2_1=0.0;u2_2=0.0iu2_3=0.0iu2_: 





yl_1=07Yy2_1=07 


xl=[0;0]7x2=10;0];x3=[05017 


Xp=O.02017 
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Xi=D-05D7 
KG=0.00017 


erTor_1=1070]7 
七 S= 工 F 

ftor Kk=131:1500 
七 Re fi) =Kwt 避 7 


&Step 8ignal 
&R= [130] 了 
R={0;1L]7 


$%PID Decouple Contreoller 
ul(K)=kP*xl(I)+KQAXx2(LI)+Kixx3fILI)17 
2(Kk)=kp*x1(2)+kdwx2(2)+Kiwx3(2) 17 
u=[ul(k) ,ua24k)]17 


iE ultk)>=10 
ulLIK) =107 

end 

E u21{Kk)>=10 


Uu2(Kki=101 
emnd 
ifE ul(ky<=-1 人 0 
lt{k) =-I107 
emo 


it u2(Kk)<=-10 
ua (k)=-101 


endQ 


#Coupling Plan 


Youkt1l(k)=1,07(1+yY1_1)^2*10.8*yY1_1+uL_2+0-2xu2 3)7 
Yout2(k)=1.07(1+y2_1)^2*(0.9*Yy2_1+0.3wu1_3+u2_ 2]7 


errorl (k)=Rt1) -Yout1(Kk) 7 
errOoF2(K)=RI2)-YOut2(K) 


error=[errorl(k) ;error2(k)]7 


g%----------- Return of PID parameters---- 一- 


ul_4=al_3rul_3=ul_2;ul_2=ul_l;al_l=ul1)7 
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6.13 多 变量 PID 控 介 的 Simulink 仿 丙 





没有 相合 二 变量 硝 合 被 控 对 象 
y 估 )=1 ONT+ 大 一 1008 全- 站 + 区 全 -及 +O2w(K-3)) 
fk)=1LONI+ 吕 仆 -10.9y 人 -TU+03u(k -3)+o 人 全 -2 功 


设 采样 时 间 T=Ls。 才 





为 单 4 








量 6-4 yt) 只 放 击 线 


* 250 * 


TIERRTTTEICEE 





图 65 (Ni 响 旋 井 吉 


的 Simulink 主 程序 ，chap6_2.mdl， 如 图 6.6 所 玫 


仿真 和 























图 66 PLD 御 制 的 Simalink 仿真 程序 


S 函数 授 揣 子 程序 ，chap6_2s.m 
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erreor( ['Unhanaqlead flag = ,num28tz (flag)y]) 


enQr 


有 = 





多 When fiag=0，Dperfeorm System Jinitialization 





和 = 
function [sys,x0,str,ts] = malTnitializesizes 
sizes = simsizes; # read default control variables 


sizes.NumcontStates = 0 g Do continuous 8tates 

sizes.NumDiscStates - 3; % 3 states and assume Lhey are the P/I/D components 
SIzeS -NUmOUEPutS 一 工 7 当 2 output variables: Control ult) anQ State Xt3) 
sizes NumInputa = 21 % 4 input signals 

sizes.DirFeedthrough = 1;g input reflected directly in OUtPut 


sizes.NumSampteTimes =- 17% single Sampling Deriod 


sys = simsizesfsizes); 多 

x0 = [0 0; 0]7 更 ZeTO imit 主 al StateS 
strz = []: 

ts= [10]7 当 Sampling Pericd 





when flag=2，updates the discrete States 











多 = 
fanction sys = malUpdates(xvu) 
T=11 
SYS=[ utIL) 
xXt2)+ut1)*T7 
tuUILI-uf(2))7ZT] 1， 
多 = 
% when flag=3，compucates the output signals 
$%= 


function SYS = malOutputstt-Xxru) 


kp=0.025 
ki=0.05; 
ka-0.0001: 


多 SYS=TKP ,kiKQJxx7 

SYS=KPpxXit1)+KIYX(2)+KGAX(3) 7 

被 控 对 和 象 的 Simulink 仿真 子 程序 :由 简单 的 Simulink 模块 和 离散 8 函数 组 成 ， 如 图 6-7 
所 示 。 
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国 [本 



































SFundion 











Delay 
Ts) ; 
了 圳 | shape_2plamt 二 > 
Delawe 























-| 
z | ua) 
Delage 








图 6-7 ”被 控 对 象 的 Simnlink 仿真 子 程序 
3 函数 被 控 对 象 季 程 序 ，chap6_2plantm。 


function [sys,xnvstr,tsj=mm_madel_nitt,xiuvflag,T) 
switch flag， 
case 0 $% InitialLlZation 
[sys,x0,Str,ts] = mdlInitializeSizes(T] 17 
case 3 $ evaluaticon of outputs 
sys = mdloutputsful， 


case {1，2，4，9} $ undqefineq flag valueSs 


sys = []; 
otherwise 当 error hanqljing 

errorf['Unhandled flag = ',num2stT(flag)])7 
emQ 





nitialization Processed or the SYSstetn 








function [sys,x0,Str,ts] = mdlInitializeSizes (T) 


sizes = simsizes) $ read the default templates for the SYSLerm VariableS 


Sizes.NumContStates =- 0; g% no continuous States 
Sizes.NumDiscStates -= 0 % 6 discrete states， [X1-X3] 
sizes.Numoutputs -= 2;) $ control variable ulk) andq PID Parameter 
sizes-NumInputs = 5; $ 7 input signals 

sizes.DirFeedthrough = 1; g% inputs are needed in output evaluation 


sizes.NumSampleTimes - 1; % single sampling periodq 


ays -= simsizes(sizes)) $ setting of system variables 
x0 = []; 丰 zero States，and 0.1 for initial weightSs 
Stz = []: 

ts = ITo; 当 Tis the sampling period for the sySEem 


function sySs = maloutputs(u)} 
sys=[(0.8xull)+ul3)+0.2x*uU(6))VtL+ut1)) 227 
10.9x*ul2}+D.3*uta)+ut5))7tT+ut2)) 2]7 
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6.2 单 神 经 元 PID 控制 
6.2.1 单 神经 元 PID 控制 原理 


通过 单 神经 元 PID 控制 ， 可 较 好 地 实现 对 多 变量 控制 ， 图 6-8 给 出 二 变量 单 神经 元 PID 
控制 系统 框图 ， 该 系统 由 两 个 单 神经 元 PID 控制 器 构成 。 


> | 单 神经 元 plIpI| 世 >| 
和 一 
| 单 神经 元 PID2 站 ”| 


图 6-8 - :变量 单 神经 元 PID 控制 系统 框图 

















多 变量 | 
被 广 
对 象 > 
































单 神经 元 自 适 应 控制 器 是 通过 对 加 权 系 数 的 调整 来 实 班 自 适 频 、 自 组 织 功能 ， 权 系数 的 
调整 是 按 有 监督 的 Hebb 学 习 规 则 实现 的 。 以 第 一 个 单 神经 元 PID 控制 关 为 例 ， 控 制 算法 及 
学 习 算法 为 : 


3 
丽 ( 关 一 荔 估 0 + 丙 祁 十 (区 (有 (6.2) 


各 
3 

它 ( 罗 = 如 (7 wd 
所 


Wi( 癌 = 有 人 -D+TzCEECEDACR 《6.3) 
na( 阳 一 ma 并 一 ]) 二 有 pz(K)M(K)xafk 
(人 一 雹 大 一 D) 十 Foz(KJ2(EJ As) 
式 中, xi( 生 =eCe; 
和 (有 =e( 人 一 e 估 一 
( 扫 =Aze( 有 一 e() 一 2e( 天 -DT+e 一 2); 
Time 分别 为 积分 、 比 例 、 微 分 的 学 习 速率 ， 无 为 神经 元 的 比例 系数 ， 石 >0 。 
对 积分 、 比 例 和 微分 分 别 采用 了 不 同 的 学 习 速率 1,me,mp ， 以 便 对 不 同 的 权 系数 分 别 进 
行 调 整 。 
大 值 的 选择 非常 重要 。 乓 越 大 ， 则 快速 性 越 好 ， 但 超 调 量 大 ， 甚 至 可 能 使 系统 不 稳定 。 
当 被 控 对 象 时 延 增 大 时 ， 石 值 必 须 减 小 ， 以 保证 系统 稳定 。 石 值 选择 过 小 ， 会 使 系统 的 快速 
性 变 差 。 


6.2.2 份 真 程序 及 分 析 


仿真 实例 
仍 以 PID 控制 中 一 变量 耦合 被 控 对 象 为 例 ; 
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态 (的 =10H1+ 太 大 -7200.8 六 全 -JJ 十 本 (天 -2 二 0.24( 人 大 -3) 
六 (加 =1010+ 六 2 帮 -1)2009yE-D+030 人 天-3)+to( 伙 -2) 


设 采 样 时 间 了 =1s 。 给 定 输入 为 单位 阶 路 输入， 即 : 
“oj 
到 ( 引 | [LO0 
-so 上 
为 (的 | 
采用 单 神经 元 PID 控制 ， 取 后 = 总 =0.16 。 局 为 第 二 个 神经 元 的 比例 系数 。 当 输入 指令 
为 玉 时 的 响应 曲线 如 图 6-9 所 示 ， 当 输入 指令 为 杞 时 的 响应 曲线 如 图 6-10 所 示 。 





























1.2 - 一 - - 








timets) 
图 6-9 响应 曲线 (R=[0]) 








1000 1500 


0 500 timels) 
图 6-10 响应 曲线 (R=]) 


与 PID 控制 相 比 ， 单 神经 元 PID 控制 具有 响应 速度 快 ， 自 适应 能 力 强 ， 抗 干扰 能 力 强 等 
仿真 程序 ，chap6_3.m。 
ssingle Neural Net PID Decouple Controller based on Hebb Learning 


SRALSorithm to aqjust kP,ki,kd 
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clear al17 


close al17 


xc1=I0,0,0] 7 
Xc2=[0.0,0] 7; 


xieP=DO-407 
XiteI=D.407 
XiteD=0.401 


%Imnitilirzing xp,ki anq kQ 
%Radom Value 
swkpl_1=randgiwkil_1=randiwkdi_1=randy 


Suwkp2_1=randiwki2_1=randiwkd2_1=randi 


wkp1_1=0.3150;wkil_1=1.1615;wkd1 1=1.4948: 
Wkp2_1=0.20637wki2_1=0.6365)wkd2 1=0.49967 


erOrl_1L=07;errorl_2=07 


GTFrOr2_1=07ezrDT2_2=017 


ul_1=0.0;ul_2=0.0;ul_3=0.07ul_4=0.0; 
u2_1=0.07u2_2=0.07;02_3-0.07n2_ 4=0.07 


Yy1_1=0;y2_1=01 


LSs=]17 





Eor K=1:1:1500 


二 ime (K) =JKx 蕊 虽 了 


gsStcp Sigmal 


S%R= [170] 7 
R=T07137 
S$---------- Calculating Practical output ---------- 


和 COUPpHTin9 PanL 
yout1(k)=1.07/(1+y1_1)^2+(0.8yy1_1+ul_2+0.2xu2_3) 
Yout2(k)=1.07/(1+Y2_1)^2*10.9*y2_1+0.3xul_3+u2_2) 


erOr1 (UKc) =RtIT) -YOUE1LK) 
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erTOr2(K) =R(2)-Yout2(Kk) 7 


SFEor Variable1 
8Rdjusting NNC Weight Value by adopting hebb learning algorithm 
wkp1 (KJ) =wkp]_1+xitePwerrorl(k)*ul_1xxclt1); P 


WKki1l (Kk)=wki1l_1+xireIxerTOTLTIK) xul_ txxcli2)7 江 
wkqltk)=wkadl_1+xiteDyerrorl(k) sul_1xxcl(3)7 多 D 
XC111) =error1(k) -errorl 1: 针 也 
XC1(2) =errorltk) 7 勇 工 
xcl(3)= (errorl1{k)-2xerrorl_1+error1_2) 17 锡 D 


waddl (kj=alps {wkpl1k) )+abs (wkil(kl)+abstwkGItk)); 
WwW11LLIK)=wkP1(k) waddl(k) 

WwW122 (k)=wkiltk)ywaaalik)7 
wdl33(k)=wkaltk)“wadaltk) 7 
wl=[wllLtfk])，w122(k)，w133(k) > 

K1L=0.167 

u11{k)=ul_1+klxwz*xcl: 





和 Fot Variab1le2 

%adjusting NMNC Weight value by adopting hebb learning algorithm 
WEKKDP2 (jk) =wWKP2_1+xitePxerror2(khxu2 17xXc211)7 SP 
wki21Kk) -wki2 3+xiteIyerrOr2(khyD2_1wxc212) 名 工 
wka2 (K) =wkG2_1+xiteDxreTLOT2 (KU2_1wxc2t3)7  gD 


xc2 (1) =erTOr2 (k) -errOr2_17 名 P 
XC21(2) =erLOr2 (KK 喝 工 
Xc243)= (error2{K)-2+erroT2_ 1+erFO2_21)1 D 


wadd2(k)=abs(wkp2(k] )+abs (wki2(Kk))+abstwkd2(k)) 7 
WwW211(K)] =wkp2(K) /waad2 (X) 7 

W2221K)=wki2(kK) wadda2(k) 

WwW233 (kj =wka2 (K) ywadQG21k) 7 

WwW2=[w2t11(K)，w222(K) ，w233(K)] 

k2=0.167 

U2(Kk) =u2_1+K2*w1x*XC27 





$----------- Return of PID ParameLers- 
%For Variablel 
error1_2-errorl_ 11 
erraor1_1=errorl(k) ; 
wkp1_1=wkpl1(k) 7 
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wjkkQ1_1L=wkaQl(k) 7 
wkil_l=wkiltx) 


ul_4=ul_31 
ul_3=ul_2; 
ul_2=ul_ 1; 
ul_1=ul4k) 7 


Y1_1=Yout1(k)7 


%FOr Variable2 
ETTOT2_2=errOTr2_ 1 
GTTOIT2_1=error2(K) 
WwWkPp2_1=wkp21K) 7 
WwWkG2_1=wikQ21X) 1 
wki2 _1=wki2tk) 7 


u2_4-u2_37 
2.3=u2_27 
Du2_2=u2_17 
Qu2_Tz=a2(kK) 


y2_1=yout2(k) 1; 
emdQ 

EiGmre1lI) 7 
BlLot ttime,Rt1)，k' timeyout1 ki 
hela ony 

plot ttime,R12)，' 





timevyout2，K 7 





X1abel('time(sj') yl1abel(' rin yout') 7 
6.2.3 多 变量 单 神经 元 PID 控制 的 Simulink 仿真 


设 有 耦合 二 变量 耦合 被 控 对 象 : 
(=100+ 太 开 -D208nN-D+mk -2+D02 人 -3)7 
六 ( 间 =1.010G+ 万 帮 -D2(0.9 六 人 - 划 +03u( 帮 -3)+ 力 全 -2 
设 采 样 时 间 了 =1ls 。 给 定 输入 为 单位 阶 跃 输入， 即 : 
局 
肌 ) 一 一 
疡 (人 11 


响应 昌 线 如 图 G-11 和 图 6-12 所 示 。 
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| 属 惠 | 只 户 矶 | 朴 范 为 | 昌 三 





儿 | 6G12 JJ 妇 呈 应 和 战 








四 6-13 从 神 缀 元 PID 控 捍 的 Simulink 仿真 程 岩 





第 一 个 8 函数 控制 子 程 序 :chap6_4sl.m 

8Single Neural Net PID Pecouple Controllcr baseq on Hebb Learning 

8R1gorithm to adjust xp,ki,kd 

function [SYSs,x0,stzits]=exPp_Pidf(t,x,uflaS) 

Switch flag， 

Case 0 委 nitIalLizations 
fsys,xD,stritsl = mdlInitializeSizeB7 

case 2 # discrete states updates 
sys = mdlUpdates (xu) 

case 3 &% Cormputation of contrcl sgmnal 
sys=mdloutputstt ,xu) 


Case {1，4，931} 当 unused fl1ag ValueSs 


sys = []? 
otherwise 遇 error hanq]ling 
arror(['Unhanaled flag = ,nnm2stz(flaSG)])7 
end; 


名 = 
g% when flag=<0，Pperform System initialization 








function [sys,x0,str,tsl = mdlInitializeSizes 


sizes = SimsizeSs: read default control variables 
sizes.NumContStates = 0; g no continueus States 
sizes,NumDiscStates = 3; 8 3 states and asSume they are the P/I/D ComponentS 





sizes,NumoutbuLs = 2 output variables: contrcl utt) and state X(3) 
sizes.NumInputs = 3 % 4 input signals 
sizes.DirFeedthrough - 1;8 input reflected directly in Cutput 


sizes ,NumsampleTimes = 1;8 single sampling Perioq 


sys - simsizestsizes); 刍 

x0 =- [9 01 0]17 入 zerO iniLial states 
Str = {] > 

re = [-1 0]; s sarmpling period 





function sys =- mdlUpdates(x,u) 


X{2)+uU(L)*T7 
tatl)-ut2))7T]: 








有 when flag=3，computates the ouLDut signals 
&= 





function sys = mdlOutpukstt ,xu) 
persistent wkpl_1 wkil_1 wkal_l ul 1 
xiteP=0.501 

XiceIT=0.60: 


XiteD=0.607 


if t==0 g%Tnicilizing kp,xj anQ kq 
WP1_1-0.31 
wki1_1-0.31 
TWkdl =D-37 
ui_1=D; 


eng 


sadjusting NNC Weight Value by aGopting hepb learning algorithm 
wkpP1=wKP1_1+XirePxXt1) *uU1_L*X(I) 1 多 P 
wpkil=wkil_1+xiteTwxt])*ul_1x*x(2); 8I 
wkdl=wkal_1rxiteprxtl)*ut_1yx(3)7 9D 


wadal=abs (wkpl)+absiwkil)+abstwkG1》 
WwW1L1L=wkp1l7ywaddl7 

WwW]122=wkilywaddl7 

w133=wkdlywaadl: 

w1=fwl11,w122,w133] 

K]1=0.207 

TIL=K1*WLYX7 


wkpl_1=wkpL: 
Wka1_1=wkeal7 
wkil_1=wkil; 


ul_I=ul:; 


SSY&=U1L7 
第 二 个 $ 函数 控制 子 程序 ，chap6_4s2 me。 


%Single Neural Net PID Decouple Controlle 工 based on Hebb Learning 
$%A1goribthm to aqgjust kp,kiykd 

funcetion [sys,x0,Sstr,ts]=exp_piaqf (L ,xu 上 IaS) 

Switch 工 Lag， 
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case 0 和 initializationgs 
[sys,x0,str,tsj = mdlTniLializeSizesi 

case 2 8 discrete sbates updates 
svg = mdlUpdates (xiul; 

case 3 $_ computation of control signal 
sys=mdloutputstt, Xuli 


Case {1，2，9)} 区 unaseQ flag values 


syYs = []; 
otherwjise $ error handling 
errorf['Unhanaled flag -= ,num2str(flag]1)7 
endy 








3 = 

当 when flag=0，Pperform system initialization 

名 二 

function [sys,x0,str,ksl = melInitializeSizes 

sizes = simsizesi $% read default control variables 


Sizes.NumCcontStates = 0; % no continuous States 
sizes.MNumDiscStates -= 3 8 3 states anqd assume they are the P/I7D ComponentSs 


SizeSs,NumoutPputs = 多 2 output variables: control utt) and state X(3) 





sizes.NumInpuks = 37 s 4 input signals 
Sizes.DirFeedchreugh = 1;% input reflecteQ directly in ourputL 


sizes .NumSsampteTimes -= 17g single sampling periodQ 


Sys = simsizes(sizes); 多 

x0 = [0 07 9]7 多 ZerO initial states 
Str = [: 

ts= [-1 0 多 Sampling Deriod 





% when flag=2，updates Frhe discrete states 





多 = 
function sys = mdlUpaates(x,u) 
T=17 


SYS=L utLI 
(2)+uLJYT 
(uta)-uf3))7T]: 


第 = 
sa when flag-3，computaces the output signals 
名 = 


function sys =- malOutputstt:x,u) 








Persistent WwWkp2_1 wki2_1 wkd2_1 u2_1 
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xicep-0.60; 
ie 工 =<D -6 
Xitep=D.5601 


if t==0 Initilizing kbp,ki ana kq 
wkp2..1=0.31 
WwWKi2_1=0.37 
wka2_1=0.31 
u2.1=0; 


ena 


8RajusLing NNC Weighr Value by adopting hebb learning algorithm 
KBP2=wWKP2_1+XitePxx(1)su2_1*xfd)7 名 了 
WKi2=wki2 1+XiteIxrx(T)*u2 1*Xf2) 7 要 


Wkd2=wkd2_1+xitepDsx(1L)x*u2_1*xt3)7 和 D 


wadd2=abs(fwkp2)+abstwki2)+abs(wkd2) 7 
w211=wkp27wadd27 

WwW222=wki27ywaddq27 

w233=wkaq2ywadqq27 
WwW2=[fw211,w222,w233]7 

k2=0.207 


2=K2*W2*X7 

wkPp2_1=wkp27 
WwWKkd2_1=wkQ27 
WwWKi2_1=NKki27 


Uu2_1=u27 


SYS=u27 


被 控 对 象 的 Simulink 子 程序 及 其 肯 数 程序 同 chap6_2.mdl 中 的 被 控 对 象 程序 。 
6.3 基于 DRNN 神经 网 络 整定 的 PID 控制 


6.3.1 基于 DRNN 神经 网 络 参 数 自 学 习 PID 控制 原理 


双 输 入 、 双 输出 多 变量 自 整定 PID 控制 器 如 网 6-14 所 示 ， 其 中 NN1 和 NN2 为 神经 网 
络 ， 用 于 控制 器 山 和 的 PID 参数 为 后 几 , 如 。 二 和 天 为 系统 输入 指令 ， 闷 和) 为 系统 输 


出 值 。 
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三 症 | NN1 
1 
对 
| _NN2 象 
一 | 册 >| 广 























图 6-14 多 变 昌 自 整 定 FID 控制 器 
以 控制 器 由 为 例 ， 控 制 算法 如 下 : 
四 (人 ( 提 一 和 Ti( 人 十 丰 CE)xa(K) 二 Ki(K)T3(K) 《6.47 
erron ( 癌 二 (向 一 了 (人 
且 有 有: 
六 ( 阳 一 erron (大 ) 
忆 ( 有 = 可 Geron(Dx7 《6.S) 
上 
erron (K) 一 erron (类 一 1) 
了 
式 中 ，T 为 采样 时 间 ，PID 三 项 系数 如 ,(k),(t),ai(k) 采用 DRNN 神经 网 络 进行 整定 。 
定义 如 下 的 指标 : 


3(K) 一 








Da(0D 一 GO (66) 
噩 的 = 直人 -0 而 一 名 人 -0+ 帮 人 人) 的 9 
5 9 (67) 
= 名 信 -DA DCD) 吕 (9 
困 
(向 = 铅 代 -D 一 n 讼 = 后 估 -D+ 太 (( 一 0 得 四 
人 (6.8) 
-Rak-D+RGCD-n0D) 吾 (0 
人 (=Aa 人 -Di 和 -At-D+mCitD- 0 站 2 
和 四 (6.9) 
3 


= 一 D+TCCGD) 一 3 (6 


式 中 ， 盆 为 对 象 的 Jacobian 信息 ， 该 信息 可 以 由 DRNN 网 络 进行 辨识 。 
斩 
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6.3.2 DRNN 神经 网 络 的 Jacobian 信息 辨识 


DRNN (Diagonal Recurrent Neural Network) 神经 网 络 是 一 种 回归 神经 网 络 ， 网 络 结构 共 


有 三 层 ， 隐 层 为 回 凡 层 。DRNN 神经 网 络 的 结构 如 图 6-15 所 示 。 





图 6-15 DRNN 神经 网 络 结构 


在 DRNN 神经 网 络 中 , 设 了 = 四, 忆 …, 轧 ] 为 网 络 输入 向 量 ， 五 ( 为 输入 层 第 个 神经 元 
的 输入 ， 网 络 回归 层 第 7 个 神经 元 的 输出 为 和 人) ,SC 为 第 7 个 辐 归 神经 元 输入 总 和 , AD 


为 8 函数 ，O(5) 为 DRNN 网 络 的 输出 。 
DRNN 神经 网 络 的 算法 为 : 


O(D= 也 有 ypXi( 间 ，X(O= FSi0D) ，Si( 各 = 厂 PXiCCD+ 袜 瑟 避 ( 
7 1 


式 中 ， 赋 2 和 印 9 为 网 络 回归 层 和 输出 层 的 权 值 向 量 ,本 
为 网 络 输入 居 的 权 值 向 量 。 

在 图 6-16 中 , 上 为 网 络 的 迭代 步骤 ，xA) 和 ?(j 为 状 
识 括 的 输入 。DRNN 为 网 络 辨识 货 。yY( 昌 为 被 控 州 象 实际 
输出 ，ymt(i 为 DRNN 的 输出 。 将 系统 输出 y(K) 及 输入 
xj) 的 值 作 为 辨识 器 DRNN 的 输入 , 将 系统 输出 与 网 络 输 
出 的 误 美 作为 辨识 器 的 调整 信号 。 





























人 (6.10) 
2 人 护 、 报 生 有 惠 -，“ 
， 
DRNN 
7 


图 6-16 DRNN 神经 网 络 辨 识 


网 络 输出 层 的 输出 为 : 
ymto=O(R=w Ri) 《6G.11) 
网 络 回归 层 的 输出 为 ; 
忆 交 了 一 (SR 《6.12) 
网 络 回 具 层 的 输入 为 : 
SOD=WXK-D+》 Oo 《6.13) 
拓 识 误差 为 ; 
em( 吕 = 7 有 一 ym() (6.14) 
扒 识 指标 取 : 
Em( 昌 = 二 em 《6.15) 
学 习 算 法 采用 梯度 下 降 法 ， 
。 9Em(b) 9yrm 
Am?( 和 = 一 一 一 一 em( 刀 一 em( 上 Xi) 《6.16》 
8 9w7 
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(一 1D)+TAw ED)+CO 一 D 一 ww ( 关 一 2)) 














《6.177 


9Em(R) 9ym Dym 9X， 
Anoi( 扑 = 一 了 一 
5 人 油 (9 名 加 3 现 一 em(iw; Gy (6.18) 
但 罗 =W 伙 一 D+TAwCD+TCO 人 -TD 一 屿 一 2) (6.19) 
2 aym 9 
大 一 一 oo 
PC) em 让 坟 洲 em(ow?P(O 06.20) 
(= 二 站 人 _D_wptk 一 2) (6.21 
其 中 ， 回 归 层 神经 元 取 双 S 函数 为 : 
1_erz 
COD= 一 全 (6.22) 
1 + 
POO= ax - 《623) 
忱 ， 
@( 昌 = 一 一 = 《6.24) 
wy 
式 中 ， 市 、71p 、 加 分别 为 输入 尼 、 回 归 层 和 输出 层 的 学 避 速 率 ， w 为 惯性 系数 。 
对 象 的 Jacohbian 信息 龟 开 为: 
-9 
双 2 WwW (Sn (6.25) 


6.3.3 仿真 程序 及 分 析 


仿真 实例 
仍 以 PID 控制 中 二 变量 耦合 被 控 对 象 为 例 : 
hi(G=1LOU+ 太 人 -1D)200.8y(E -JJ+aE-2+O2( 开 -3) 
夯 (=1LOU(L+ 太 下 -DO0.9 交 估 -D+030 人 -3)+io( 人 -2) 
设 采样 时 间 为 1s。 给 定 输入 为 单位 阶 跃 输 入 ， 即 ， 


和 
(0 
玉 [ido] 0 
2” 150] | 





采用 基于 DRNN 神经 网 络 整定 的 PID 控制 ， 网 络 结构 取 3-7-1， 网 络 输入 为 
了 = 攻 k-D,y0D10}，m7 =040，no =040，m =0.40，wx= 0.04， 权 值 取 [-1+] 范 围 内 的 











随机 值 。 


当 输 入 指令 为 忍 时 ，Jacobian 信息 及 响应 结果 如 图 6-17 和 图 6-18 所 示 ， 有 ivka 和 


如， 











结果 如 图 6-21 和 图 6-22 所 永 ， 太 ,后 和 各 sjaskaz 整 定 结果 如 图 6-23 和 


图 











大 ss 整定 结果 如 图 6-19 和 图 6-20 所 示 。 当 输入 指令 为 瑟 时 ，Jacobian 信息 及 阶 跃 响应 


6-24 所 示 。 


与 PID 控制 相 比 ， 基 于 DRNN 神经 网 络 整定 的 PID 多 变量 控制 具有 响应 速度 快 ， 自 适 
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应 能 力 强 ， 抗 干扰 能 力 强 等 优点 


1.5 广 
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1.5 
0 1000 1500 
500 time(s) 
图 6-17 Jacobian 信息 ( 玉 =110]) 
2 -- -- 一 
0 500 1000 1500 
time (s) 
图 618 DRNN 控制 响应 ( 灵 =[L0D) 
1.51 一 
| 
] 
盛 | 
全 05 
0 加 上 
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timefs) 


图 6-19 。Kpt ,kal 的 整定 缚 洒 
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kp2 ki2 kd2 


Jacoblan 





0.5 


吕 
中 


局 
P 


站 .一 





500 timels) 1000 


图 6-20 kofia,koz 的 整定 结果 











500 timets) 1000 


图 6-21 Jacobian 信息 ( 玉 =[E0]) 








500 1000 


timeds) 


图 6-22 DRNN 控制 啊 应 (R=[0:1T) 


1500 














0.3 
吾 025 
豆 
互 02 盖 一 
人 号 

0.15 

0.1 - - | 

0 500 1000 1500 
timets) 
图 6-23 大 pi,5 Ka 的 整定 结果 


0.4 


kp2 ki2 kd2 
局 
名 


品 
则 





1000 1500 


马 
= 
| 

| 

| 


time(s) 


疼 6-24 pa ,Kiz,Kaz 的 整定 结果 


仿真 程序 ，chap6_5m。 

， 
8DRNN Tunning PEID Controller foer coupling planL 
Clear all17 


Cose 总 ] 工 : 


ul_1=0.0;ul_2=0.0;ul1_ 3=0.01 
u2_1=0.0iu2_2-0.0;u2_3=0.0: 
yl1_1=0;Y2_1=0: 


WwWQ1=Yanast73 1 
wol=Fands (7 ,1) 7 
WIIT=Eands (3，7) 了 


wdl_T=wdtywol_ 1=wozyrwil_ 1=wily 
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X1L=Zerosr7 1) 7 
XI _L=X3 


wa2=rands17,1) 7 
wo2=rands(7,1) 1 
wji2=randg13，7) 1 
wd2_1-wd2;wo2_1-wo2;wi2_1=wi21 


Xiteil=0-407xitedl=0.407;xitecol=0.407 
Xitei2=0.40;Xiteq2=0.40;xitec2=0.407 
alfal=0.047alfa2=0.0417 


X2=Zerosr7 1) 7 
X2_1=xX21 


errorl_1=01errorl_2=0; 
7 





etCr2_1=0;erTor2_2= 


kpl=0.307Ki1=10.1507kdI=0.2; 
kp2=0.307ki2=0.1507:kq2=0.27 


jpl_1=kpl;kal_1=kalykil 1=kily 
kp2_1=kp27kd2_1=kd2;ki2_1=Ki21 


XLekbpbl=0.5:xitekq1=0.37;Xitekil=0.0017 
Xitekp2=0.5;xitekd2=0.37Xiteki2=0.0001: 


il=0zei2 





8=1; 


Eor K=T:1:1500 





七 ime {K) = 区 * 七 号 


负 SteDp Signal 
R= [1;0] 7 
SR=[LO71]7 


#Coupling P1ant 
youtltk)=1.0/(1+y1_1)^2*10.8*y1_1+ul_2+0.2*u2_3)1 
yout2(k)=1.0711+yY2_1)^2*(0.9xy2_ 1+0.3xul_3+u2_2) 


ITnl=[ui_1,yYout1LT(k) 1] 
for j=1:1:7 
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si)j=Inl'xwilf: 了)+wdal(J)wxlt) 7 


em 巡 


for j=1:1:7 
xltj)=(1-expt-sit)))/A (1L+exPpI-sSit 了 J))) 7 
end 


Pi=O*X17 

for j=1:1:7 
Pi(j)=wol(j)*(t1L+xl(]J))*(1-xlt 了 jj)) xxT1() 7 

enQ 


Qi=0xwil7 
for j=1:137 
for i=1:13:3 
Qiti,j)=wol(3)*(1+xl(J))*tL-xl(j))xInl(i) 
ena 


ena 


Ym=07 

for j=1:13:7 
Ym=yYm+X1(j) swol ty) 

ena 


Ymout1(K) =Ym7 


wol=woL+XiteoT* (yout1l(K)-Ymoutj1(k) )*X1+alfalrtfwolI-wol_1) 7 
wdl=wadl+xiteaQlr (youtl(k)-ymout1l(k))*Pi+alEal*twdl-wGl 1)7 
fEer Jj=1:13:7 

荆 E abs (wd1 (了 ) ) >1 

wdl0j)=0.5xsicmtwa11]) 

end 
end 
wil=wi1+xiteil*(youtl(k)-ymout1(k))*Qi+alfal*(wil-wiT 1) 7 


Yu=07 





for j=1， 
yu=yurwoltjjxwilt1,j)x(L+xlLftj))*(T-xL( 了 ))1 
enq 


Gyoutl (ky =yu7 
erFor1(k)y=R(I) -Yout1(k) 
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xcl(1)=errorlftk) 7 $Calculating 已 
Xc112) =errorI{tK)-errorl_1; gCalculating 了 
eit=eil+errorl(K)yLS 


Xc1l(3?=eil: Calculatirlg 工 


KP11k)=kP1_1+XitekPpl*rerrcr1T(K) xxXC1{1) 
kdttk)=kq1l_1+Xxikekdl*xerrorl(k)xxclfI2) 
Kiltk) =kil_1+Xitekil+errorlLtk)xxcl(3) 7 


pi tK) =kp1_1+Xitekpl*errorl[Kk)wxcl(1L)*Qyout1L(K) 7 
kadl(k)=kd1l_1+xitekqlwerrorl(k)x*xcl(2)*dyout1L(ky 7 
Ki1L(k)y-ki1 1+xitekilwrerzrorltk)x*xclt3)*Gyout1l(K) 7 


if Xpl(k)<0 
kP1(K)=07 

engq 

E kaqlfk)<0 
kal(k)=07 

end 

E kil(x)<D 
Ki1(K)=0; 

endq 





uiT(kK)y=KP1L(k)xxcLt1)+kd1l(K) xc1lt2)+KiL1K)*xCl(31 1 


利和 多 光 秆 条 千 告 咎 时 秆 入 务 名 多 第 千 千 车 入 备 务 千 务 秆 务 和 客站 省 和 备 绩 各 秆 针尖 和 忆 条 竺 和 务 千 和 于 第 千秋 各 
In2= [1u2_1,Yyout2(K) ,1] 1) 


for j=1:1:7 
sdtj)=Inl'rwi24:，)+wd20j)xx2(j)1 


end 


for jc=lis:1:7 
x2(j)=(1-exp{-si(j)))7(1+expt-sitJ))) 7 


em 


Bi=Gxx21 
for j=1:1:7 
Pitj)=wo2(j)*(tL+X20))*(L-x2( 了 ))*X2_1{t]) 7 


endQ 


Qi=Oxwi21 
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for jj=1:1:7 
for i=1:1:3 
Qi tj)=wo2(j)xt1+x2 人 0))* (二 -X2())xTn2(i) 7 
ema 


end 


ym=Di 
Eor j-1:13:7 

Ym=ymrx2 (jh xswo2 (ji 
end 


YmOUL2 {K] =YTIY 


wo2=wo2+xiteco2y (ycuL2 (K) -yYmout2{1K))*x2+alEa2* (wo2-wo2_1)1 
wd2=wd2+Xited2+ (Yout2(K) -ymout2(Kk))x*Pt+ralfa2* (wd2-wd2_1)7 
foer j=1:1:7 
IE abs{wd2{]j) ) >1 
wd2(j)=0.5*sign(wd21j)) 1 
end 
ena 
wji2=wi2+xitei2x (yout2(k)-ymout2(k))xQiralfa2x fwi2-wi2_1) 


Yu=01; 
for j=1:1:7 

yu=yu+wo2 (jj wwi2(1,j)x*(1+x24 了 ))*(1-x2(3)) 1 
ena 


ayout2(Kk)=Yyui 


errOr2 (k) =R(2) -Yout2(K)] : 


XCc2(1L1)=errer2(k) 7 8%Calculating P 
Xc212)=error2 {k)-errcor2_17 和 Calculating 了 
eji2=ei2+ertor2{tk)xts7 


xcC213)=ei27 甸 Calculating 工 


Kkp2 (X) =KP2_1+Xxitekp2*error2a (IK)*Xc2at1) xdyout21K) 
kad2{K) =kd2.1+xitekad2*error21k)*xc2t2)x*ayout2(k) 
ki2(Kk)=ki2_1+Xiteki2xerror2 (K)*XC213)*dyout2(k] 7 


E KKp2 (k)<0 
JP2 (K) =07 
end 
E Kkq2 (kx) < 
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kQ2 (KJ =0 
enQ 
守 ki2(kh < 
ki2(K)=0; 


enQ 





U2(K) =Kp2(K)*XC211)+kd2 (K) wxc212)+ki21K)*xc2f3) 7 


SReturn of PID parameters 


errorl1_2=errorl_ 1 





ertorl_1=errorltk) 7 


error2_2=error2_1》 


error2_1=error2(k) 


wQ1_1=wdl ;wol_1=wolywil_1=wily 


wd2_1=wd2 :wo2_1=wo2wi2_1=wia7 


ul_4=ul_37ul_3=ul_2;ul_2=ul_1;ul_1=ul(k) 
U2_4=u2_3;u2_3=u2_2;02_2=u2_1;u2_1=u2{k) 


y1_1=youtltx) 





Y2_1=Yout2 ( 玫 ) 
enQ 
fiSuretIT) 


BPlot 化 imeyGyout1， 1 
xlabelft'timetS)') ;ylabelf'Jacobian' li 


Pola on 

plot (timey dyout2，'Pb')7 
Xlabelf'timets) ');y1abel('Jacobpian') 7 
figure(2) 7 





Blot (Fime,RIL) Pb time, youtT， 工 

hola ony 

plot (time,R(2) cr vtime,yout2， bj)7 
XTabelit'timetS)' )7yjabell'rinryout ')7 
figuret3) 7 

plot (time,kp1, rtime,kil, btime,kal， ki 
xlabeIf'timefs)' ;ylabel('kpl kil kql1 1) 7 
Eigure(d4) 

Pilot ftime,kp2.rvEimeyki2, btimey ka2， kx) 7 
X1abell'timnefe)');ylabelf'kp2 ki2 kG2 )7 
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第 7 章 几 种 先进 PID 控制 方法 
7.1 基于 干扰 观测 器 的 PID 控制 
7.1.1 干扰 观测 器 设计 原理 


干扰 观测 器 的 基本 思想 是 ， 将 外 部 力矩 干扰 及 模型 参数 变化 造成 的 实际 对 象 与 名 义 模 型 
输出 的 差异 等 效 到 控制 输入 端 ， 即 观测 出 等 效 干扰 。 在 控制 中 引入 等 效 的 补偿 ， 实 现 对 干扰 
完全 抑制 17,18]。 其 基本 结构 如 玫 7-1 所 示 。 








9 一 




















ca 上 











图 7-1 干扰 观测 路 的 基本 结构 
图 中 的 G,(s) 为 对 象 的 传递 本 数 ，d 为 等 效 了 
图 可 求 出 等 效 干 扰 的 估计 值 4 为 





F 扰 ，d 为 观测 的 干扰 ，* 为 控制 输入 。 由 此 


d=(erd:G0D GT(DJ-e=d 
对 于 实际 的 物理 系统 ， 其 实现 存在 如 下 问题 : 
(1) 在 通常 情况 下 ，Gu(s) 的 相对 阶 不 为 零 ， 其 道 在 物理 上 不 可 实现 ， 
(2) 对 象 Gy(s) 的 精确 数学 模型 无 法 得 到 ， 
(3) 考虑 到 测量 噪声 的 影响 ， 该 方法 的 控制 性 能 将 下 降 。 
解决 上 述 问题 的 惟一 方法 是 在 人 的 后 面 串 入 低 通 滤波 器 CQ(9) ， 并 用 名 义 模 型 Gu(s) 的 逆 


GT 人 5) 来 代 蔡 Gu(s) ， 从 而 得 到 如 图 7-2 所 示 的 干扰 观测 器 原理 框图 ， 其 中 虚线 部 分 为 于 扰 观 
测 器 。 


《7,1) 















































图 7-2 干扰 观测 器 原理 框图 
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控制 器 的 输出 为 : 








2 =c- 直 + 《7.2) 
式 中 ，< 为 PLD 控制 器 的 输出 ， 记 为 干扰 4 的 估计 值 ， 
由 图 7-2 可 得 ; 
CD Ge()Ga() 
9 Co GOD+ooGG-GCGJ 473) 
7 GoGud-ooy) 

人 一 一 卫 
mr 区 TO GO 74 
GwG)= TCD) _ Ge 5 





NG GOD+OGCGIGE0J 一 GCC) 

设 低 通 滤波 器 CQ(s) 的 频带 为 万。 当 卫 过 六 时 ，@=1，Gev = Gu(s),Gby =~0,Gny ~1。 
当 乓 > 万 时 ，@=0，Ger( =G()，Gnov(G) -Go ，Guv()=0。 通过 低 通 滤波 器 Cs) 的 
设计 可 较 好 地 抵抗 外 加 干扰 。 

由 上 面 分 析 可 见 ，Q&Gs 的 设计 是 干扰 观测 器 设计 中 的 ~- 个 重要 环节 。 次 先 ， 为 使 
CQ09GDC9 正则 ，@(s) 的 相对 阶 应 不 小 于 Gu(s) 的 相对 阶 ， 其次，Q(s) 带宽 的 设计 应 是 在 干 
扰 观 测 器 的 鲁 棒 稳 定性 和 干扰 抑制 能 力 之 间 的 折 中 。 

设 Gu(9 的 名 文 模型 为 Gu(s) ， 则 不 确定 对 象 的 集合 可 以 用 乘积 摄 动 来 描述 ， 即 : 

GCCJ= GuGML+A(C) (7.6) 








式 中 ，A(s) 为 可 变 的 传道 函数 。 
图 7-3 示 出 转台 何 服 系统 某 框 的 实测 频率 特性 G,(9) 与 名 义 模 型 Gu(? 频 率 特 几 ， 
由 图 可 见 ， 当 频 率 增 加 时 ， 对 象 的 不 确定 性 增 大 ，|A(jw 表现 为 频率 四 的 增 函 数 。 


50 rr 一 TT 















Phase (deg) 








101 1 
mdisec 


图 7-3 实测 被 挖 对象 Gp (3) 与 名 义 模型 G。(s) 频率 特性 





由 鲁 棒 稳 定性 定理 ， 干 扰 观 测 器 Cs) 鲁 棒 稳 定 的 充分 条 件 ， 
1 Acecol < 《7.7) 
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式 (7.7) 是 Cs) 设计 的 基础 ， 通 过 C(s) 的 设计 ， 可 实 岗 鲁 棒 性 要 求 。 
忽略 非 建 模 动态 和 不 确定 性 的 影响 ，Gu(s) 可 描述 为 : 
1 
GT (7.8) 
式 中 ，v。 为 等 效 慌 性 力矩 ， 久 为 等 效 阻 尼 系 数 。 
采用 如 下 形式 的 低 通 滤波 器 : 
加 3 二 1 
2 -PT 9 
由 A(C)=GiG)AG,() 一 1 可 得 A(s) 的 搜 率 特性 , 它 表 明了 实际 对 象 频 率 特性 对 名 义 模 型 
的 摄 动 ，A(s) 和 不 同 带宽 的 CCs) 的 幅 频 特性 如 网 7-4 所 示 ， 可 见 当 CCs) =2a(s) 时 鲁 棒 稳 定 
性 可 以 得 到 满足 ， 并 此 外 界 干扰 可 以 得 到 很 好 的 抑制 。 因 此 @fs) = 2:(9) 为 理想 的 低 通 滤 波 


器 ， 此 时 7=0.001。 











Phase (deg) 
1 
三 一 


1 
冲 当 











10" 1 0 
(adsee) 


图 7-4  A(s) 和 不 同 带宽 的 Cs) 的 幅 频 特性 


7.1.2 连续 系统 的 控制 仿真 


仿真 实例 
设 实际 的 被 控 对 象 为 : 
四 了 和 1 
0 00055+00675 
名 义 异型 取 : 
Gu(s) = -1L 
0.0033s2 + 0.0673s 


取 指令 信号 为 : r(D = 1L0sin(2rp) ， 干 扰 信 号 为 :da(D = 3sin(5rt) ，PID 控制 器 中 取 
后 =5.0=0 和 =050。2(s) 按 式 (7.9) 进行 设计 ， 闪 取 T = 0.001。 干扰 观测 器 的 Simulink 
仿真 程序 如 图 7-5 所 示 , 先 运行 参数 初始 化 程序 chap7_ltm， 对 于 扰 信 号 的 观测 结果 如 图 7-6 
所 示 ， 分 别 对 加 入 干扰 观测 器 和 不 加 入 干扰 观测 器 两 种 情况 进行 仿真 ， 其 正弦 跟踪 如 图 7-? 
和 图 7-8 所 不 。 
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图 7-5 干 找 双 笛 医 的 Simulink 仿 吉 程序 
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图 7.8 有 干 近 驱 届 
参数 初始 化 程序 ，chap7_1fm 





诗 的 正 引 雪 浴 


上 il 
bf 
P=ttL r [pv 1 
ft ros,t 


仿真 主 程序 ，chap7_1.mdli， 如 图 7-5 所 地 
7.1.3 离散 系统 的 控制 仿真 


由 连续 干扰 观测 吕 可 得 到 离散 干扰 观测 器 的 结 析 ,如 图 7-9 所 示 ，Q@(z”) 为 低 通 湾 波 器 ， 
出 有 ， 





疼 79 高 区 干 枕 现 测 器 的 诗 构 
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GaGz Gu(z) 








GusG-D= 
CDrOCTGCDT GCT 0 
_。 Ge-DG(zD(-OzD) 
Glene 
PC GTOCTGCOGCJ 人 
oo- Gd Dodz 





《7.12》 
G(z +O(z)(G(z -Go(c) 


设 C(z- 为 理想 的 低 通 滤波 器 , 即 在 低频 段 , 当 了 反方 时 , 2(z-) = 1 在 高 频段 ,当地 关 太 
时 ，Clz =0。 

在 低频 段 时 , 有 Gov(z = GD ,Gov(z TD)=0,Gavkz)=1， 说 明 干 扰 观 测 器 对 于 低 
频 干 扰 具 有 很 好 的 抑制 能 力 ， 但 对 低频 测量 噪声 非常 葡 感 。 在 高 频段 时 ， 有 
Gov(z = Gi(z) ,Gov(z = Go(z ,Guy(z )=0， 说 明寺 扰 观 测 器 对 于 高 频段 测量 噪声 
具有 很 好 的 抑制 能 力 ， 但 对 干扰 却 没有 抑制 作用 。 

正确 选择 如 (z- 可 实现 对 干扰 4d(b 和 测量 喉 声 x 蚊 的 完全 抑制 。 





仿真 实例 
设 实际 的 被 控 对 银 为 ， 
1 
9 0065550067 
名 义 模 型 取 ; 
1 
GD 000305T005E 


采样 时 间 为 0.001s 。 假 设 干扰 信号 为 &(6) = 50sink10rt) ，mn(b) 为 幅 值 0.001 的 随机 信号 ， 
省 令 信号 为 正弦 信和 号: r( 旨 =0.50sinf6rn0 ， 在 PD 控制 中 选取 矶 =15.0, 台 =5.0。 


Qun 按 式 〈7.9) 进行 设计 ， 并 取 了 =0.001。 图 7-10 为 Q(s) 滤波 前 、 后 信号 ， 图 7-11 









































为 干扰 4 及 其 干扰 观测 器 的 观测 结果 di ， 图 ?7-12 为 不 加 干扰 观测 器 时 的 正弦 跟踪 (CM =1， 
图 7-13 为 加 入 干扰 观测 器 时 的 正弦 跟踪 (4 =2) 。 
400 一 - -~ - 
200- 
刍 ， 
站 郴 40 人 可 
-2001 一 一 是 ~ 一 
0 02 0.4 08 08 1 
timet(s) 
100 一 一 -， 一 一 1 
1 
s 人 NAN NS 
-1001 一 -一 一 -~ 一 ) 
0 02 0.4 06 0.8 1 
timet(s) 


图 7-10 ” 低 通 滤波 器 滤波 前 、 后 信号 
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0 02 0 4timets) 06 08 1 


图 7-11 十 扰 d 及 其 十 扰 观 测 器 的 观测 结果 三 











02 0.4 tmets) 06 0.8 


图 7-12 无 干扰 观测 器 时 的 正弦 跟踪 《=1) 





0.5 


fin,yout 
局 





-1 








口 


0.2 0.8 


4iimetsj06 
图 7-13 加 入 干扰 观测 器 时 的 正弦 跟踪 《4M=2》 
仿真 程序 ，chap7_2.m。 


&PID ControlI based cn Disturbance DObservVeT 
Clear al17 
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CLOSE 己 1 二 了 


Jp=0.00757bp=0.18807 
un=Jprbn=bpi 


ts=0.0017 


GP=EEtII] [JP bp,0j))  %Plant 
Gpz=c2d{Gp,ts，'z) 
[num, Gen] = 上 tfGatalfGPz，T) 


Gn=tf([1]，[gnbn,0])7 Nominal mode] 
Gnz=c2Q(Gnts，Z) 7 
[numl,denl1]=tfdata(Gnz，v' 5 


tol=0.00657 

QQ=EE([3*fc1 1] ，[ 七 1^3，SwtO1L^2，3x 上 oOT 1T]) 7 LOw PaSsSs Filter 
Qz=c2dtQ,ts,，'tustin')y 

[numay aenG]=cfaatalQz，v' 7 


uu_1=0; 
u2_1=0) 

uc_1=0)uc_2=0;uo_3=0; 
u3_1=0)u3_2=0:u3_3=0; 


u_l1=0.07u2=0.07 
昌 :Y-_2 











error_1-=01; 


for k=1:1:1000 
七 me (长 ) = 区 < 七 号 


rintk)=0.s*sint3*2xpiwjkxts) & Tracing Sinc high frequency Signal 


$Linear model 


Yout (k)=-qent2)xy_1-den(3)*y_2+num(2) xu_T+numt 了 3) xu 27 


nkK)=0-001*Tamnaqs1l1)7 和 Meagure Hoise 


Yout {Kk) =ycut (K) +nTK) % Disturbance mkK) 
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error (kx]=rinfk)-Yocttkyy 


xft1)=erroxrtk) 7 当 Calc-Llating 王 
xft2}=(error{(k)-error_1)Vte) gg Calculucing nm 
X13) =X(3)+erTOI (K) 4tS1 8 Calculating T 


kp=50;:ki=0:kG 





了 多 TIacirS Sie Ve -Deity 


CfK) =KDY*X [1L)+KQ*xt2)+krxXf3》 和 ID ConcrO-1Ler 





，one time Qelay 


u2Ik)=1Znuml(2 umlt3)*u2_1+YyOuL (<)+dqenl12)*y_ +den213)xy_2)7 





u3(K)=u21K) uCK}: 


uoe(kj=-aengt2)*uo 1 denq(3)x*uo_2-denat4lyuo_3+numnqtll*u3s(kl+rnumd(2)*u3_1lr 


numait3)*u3_2-~Tumq te)su3 3 


=17 

TE @=-0 SNot using QIS) 
eftk)=u3f(K) 

enad 

M=17 

iE M==1 $Usirg Dbseyrver 


uatk)=ctK) -ucfk1 7 
em 
于 EM=-2 当 JO DObServe 
uUIkKJ=CIK) 


ena 


Q(kK)-50*SInIS*2xPpTrKxS) 7 
utkl=uutk)+alk)y g Disturbpance QIK) 


gs Restrjicting the Outpuz of Controller 





E KJ)< 





uk)= 1307 


enG 
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式 叶 


Uu_L=-uDfKT 


u2_t=u2(K) 


Uo_3=uo_ aruo_2=uo_ 17uo_1=uoik) 7 


U3_3=u3_27u3_2=u3_17u3_]1=u31Kk)7 


u_a=u_ 17u_ LI=ufk) 
Ya=y_1;y_1=Yout1K) 7 


error_1=errorfk) 

endQ 

figmret1) 1 

subplot (211) 7 

plot (fime,u3，K) 7 
xlabpelf'cime(s)')7YLabelf(' ua3 ) 
Subplot 1212) 7 

Pilet {timevuo， ki 
xlabezl'timefs) )7YIabelft uco 
figure(2) 


Blot {time ,9 KEimeuo eek' 1) 


xlabel('time(ts)')7ylapeil due 7 
figure(3) 

了 Lot {tjime ,rin，'k' ,time yout，K' 7 
xlabel('time(s)');Ylabell'rinyouL')7 


7.2 ” 非 线性 系统 的 PID 鲁 棒 控 制 


7.2.1 基于 NCD 优化 的 非 线性 优化 PID 控制 


MATLAB 不 人 有 用 于 动 态 系 统 仿真 的 Simulink 工具 箱 ， 还 有 一 个 专用 于 非 线 性 控制 系 
统 优 化 设计 的 工具 箱 NCD (Nonlinear Control Design)， 借 助 于 NCD 工具 箱 ， 可 以 实现 系统 
参数 的 优化 设计 。 
在 MATLAB NCD 上 具 箱 中 提供 “个 专门 作 系统 优化 设计 的 NCD Blockset ( 非 线性 控制 
系统 设计 模块 组 )， 利 用 该 模块 组 ， 系 统 的 优化 设计 可 以 自动 实现 。 


仿真 实例 
被 控 对 象 传递 函数 为 : 
G(5] = 





P，w =43,al =3。 


系统 包含 全 和 环节 和 速度 限制 环节 


1.5 


5052 +a23 +as 十 1 


土 0.8 两 个 非 线性 环节 。 了 系统 含有 不 傅 定 因素 : as 在 


40 一 50 之 间 变 化 ，a 在 (0.5 一 2.0)x3 之 问 变化。 采用 PIP 控制 器 ，PID 的 优化 指标 为 : 


“2 


84 。 





(1) 最 大 超 调 量 个 大 于 20%; 

《2) 上 升 时间 不 大 于 10s: 

(3》 调整 时 间 不 大 于 30s; 

(4) 系统 具有 和 鲁 棒 性 。 

仿真 程序 包括 两 个 部 分 :Simulink 程序 及 初始 化 的 M 本 数 程序 。 采 用 MATLAB 中 的 非 
线性 系统 设计 工具 箱 NCD 可 实现 PID 控制 器 的 优化 。 

仿真 的 关键 是 NCD 功能 的 使 用 。 在 Simulink 环境 中 双击 NCD Output 模块 ， 弹 出 NCD 
BlocKset 约束 窗口 ， 通 过 Options 菜单 和 Parameters 菜单 实现 该 功能 的 使 用 。 有 具体 说 明 如 下 : 




















1, Options 菜单 的 使 
a. 通过 Ste5 Response 命令 定义 阶 跃 响应 性 能 指标 : 


Setting time: 调整 时 间 ， 选 30s 

Rise time: 上 升 时 间 。 选 10s 
Persent setting: 稳 态 误差 百分数 ， 了 到 S 

了 Persent overshot: 超 调 量 百分数 ， 取 20 

了 Persent undershot: 振荡 负 幅 值 百分数 ， 取 1 
Step time: 启动 时 间 ， 取 0 

Final ime: 终止 时 间 ， 取 100 
Initial output; 初始 值 ， 取 0 

Final output; 最 终 值 ， 取 1 


b. 通过 Time range 命令 ， 设 置 优化 时 间 ， 取 10 一 100s 
c. 通过 选择 Y-Axis 命令 ， 设 置 阶 跃 响 应 范围 ， 取 [0.1.5] 


2. Optimization 菜单 的 使 用 


&a 选择 Parameters 项 ， 定 义 调整 变量 及 有 关 参 数 
输入 : 待 调整 优化 变 基 后, 后 , 丘 及 其 上 下 限 ， 可 取 为 : 
大 天 大 


“ 限 ， 十 一 
T 展 ， S 5 


上 限 : 55 56 5Sku 

变量 允 差 ，0.001 ”约束 允 差 : 0.001 

b. 选择 Uncertainty 项 ， 定 义 不 确 定 变量 及 有 关 参 数 

输入 ， 不 确定 变量 m,a; 的 上 下 限 ， 可 取 为 : 

下 限 : 1.35 40 

上 限 : 60 50 

< 选择 Start 命令 , 进行 调整 变量 的 优化 , 直到 阶 跃 响应 指标 达到 要 求 为 止 。 优 化 时 NCD 
约束 窗口 不 断 显示 阶 跃 响应 的 优化 过 程 ，MAILAB COMMAND 窗口 也 不 断 显 示 有 关 信 息 。 

每 次 优化 结果 保存 在 pid_nedmat 文件 中 , 以 供 下 一 次 调用 。 阶 跃 响应 性 能 限制 可 以 直接 
由 鼠标 在 NCP Blockset 约束 窗口 设置 。 

仿真 时 首先 运行 初始 化 程序 chap7_3fm， 然 后 运行 Simulink 主 程序 chap7_3.mdx《 佣 
图 7-14 所 示 )。 优 化 参数 如 下 ; 如 =1.9193, 厂 =0.0978, =8.1678, 响应 曲线 如 图 7-15 所 示 。 
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叶 || 册 








图 7-14 非 线性 系 综 世 mulink 主 程序 





图 了 -15 NCD 阶 族 响 庆 曲 线 阳 
Simulink 初始 化 程序 ，chap7_3fm 








Simulink 主 程序 ，chap7_3.mdl， 如 疼 7-14 所 示 
72.2 基于 NCD 与 作 化 函 鼓 结合 的 非 线性 优化 PID 控制 


采用 MATLAB 徘 线性 控制 系统 设计 工具 箱 NCD 并 结 侣 优化 工具 箱 提 供 的 各 类 函数 可 实 
现 PID 的 整定 
在 参考 文献 [19] 中 ,利用 MATILAEB 非 线性 蝶 小 平方 函数 sqnonlin0) ， 按照 起 小 乎 方 指标 


) =ed 进行 PLD 参数 寻 优 ， 从 而 实现 PID 的 改定 


仿真 实例 
被 控 对 象 为 ; 
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508 十 
是 国王 
丰 再 


了 T 主 性 序 chap7_4m， 优 化 结果 为 K =4.4124, 帮 =0.8809, 人 
优化 后 的 阶 茎 





=].9377 ， 采 用 优化 允 


奶 闭 7-17 所 示 








数 运行 Simulink 程序 chap7_4f2.mdi， 好 图 7-16 所 示 ， 
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图 下 16 Simulitk 程序 





图 717 优化 后 的 阶 跃 响应 





仿真 程序 分 为 主 程 序 、Mf 函数 子 程序 和 Sinlink 子 程 施 


主 程序 : chap7_4.m 








Mf 函数 子 程序 ，chap7_40.m 











Simulink 子 程序 ，cbap7_4f2.mdl， 如 阁 7-16 押 志 
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7.3 一 类 非 线性 PID 控制 器 设计 
7.3.1 非 线性 控制 器 设计 原理 


设 图 7-18 是 一 般 的 系统 阶 跃 响应 曲线 , 采用 该 曲线 可 以 分 析 非 线性 PID 控制 器 增益 参数 
的 构造 思想 。 





下 

















上 和 和 让 和 
图 7-18 一般 的 系统 阶 跃 响应 曲线 

在 参考 文献 [22] 中 ， 非 线性 控制 器 设计 原理 如 下 : 

《1) 比例 增益 参数 局 : 在 响应 时 间 0<r<n 段 ， 为 保证 系统 有 较 快 的 响应 速度 ， 比 例 增 
益 参数 如 在 初始 时 应 较 大 同时 为 了 减 小 超 调 量 ， 希望 误差 e 逐渐 减 小 时 ， 比 例 增益 也 随 之 
减 小 ; 在 1 < < 段 。 为 了 增 大 反 向 控制 作用 ， 减 小 超 调 ， 期 望 扣 逐渐 增 大 ; 在 避 S < 段 ， 
为 了 使 系统 尽快 回 到 稳定 点 ， 并 不 再 产生 大 的 惯性 ， 期 望 所 逐渐 减 小 ， 在 5 < st 段 ， 期 户 
后 逐渐 增 大 ， 作 用 与 5 St < 段 相同 。 显 然 ， 按 上 述 变化 规律 ， 马 随 误差 e 变化 的 大 致 形状 
如 图 7-19(9)j 所 示 ， 根 据 该 图 可 以 构造 如 下 非 线性 函数 : 
天 (er(D0) 一 ap 二 本 (L-sech(cperD) (7.13) 
式 中 ，m ,本 ,cp 为 正 实 常数 。 当 误差 ep 一 + 时， 局 取 最 大 值 为 op + 加; 当 e =0 时 ， 如 到 
最 小 值 为 m ， 媚 为 与 的 变化 区 间 ， 调 整 co 的 大 小 可 调整 总 变化 的 速率 。 






































徊 册 


加 
ia) 知 变化 曲线 {b) 如 变化 曲线 

图 7-19 坤 线性 增益 调节 参数 变化 曲线 
(2) 微分 增益 参数 局 ， 在 响应 时 间 0<s < 段 ， 微 分 增益 参数 如 应 由 小 逐渐 增 大 ， 这 样 可 
以 保证 在 不 影响 响应 速度 的 前 提 下 ， 抑 制 超 调 的 产生 ， 在 5 Sr < 段 ， 继 续 塔 大 操 ， 从 而 增 大 
反 向 控制 作用 ， 减 小 超 调 量 。 在 总 时 刻 ， 减 小 微分 增益 参数 名 ， 并 在 随后 的 zz < <0 段 再 次 逐 
渐 增 大 所， 抑制 超 调 的 产生 。 根 据 妨 的 变化 要 求 ， 在 构造 名 的 非 线性 函数 时 应 考虑 到 误差 变化 
速率 e, 的 符号 。 扣 的 变化 形状 如 图 7-19(b) 所 示 ， 所 构造 的 非 线性 函数 为 ; 

ja(ep(D) 二 Ga + 加 人 +cd eXP(Gd epfD)) 





园 
《人 大 变化 曲线 





《7.14) 
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式 中 ，ev = 印 为 误 美 变化 速率 ， au 和 ,cusdu 为 正 实 常 数 ，ad 为 如 的 最 小 值 ，au + 态 为 护 的 
最 大 值 ， 当 ep =0 时 ， 避 = + 加 ML+ca)， 调 整 由 的 人 小 可 调整 操 的 变化 速率 。 

《3) 积分 增益 参数 态 : 当 误 差 信号 较 大 时 ， 希 望 积分 增益 不 要 太 火 ， 以 防止 响应 产生 振 
功 ， 有 利于 减 小 超 调 星 ， 而 当 误 差 较 小 时 ， 希 望 积分 增益 增 大 ， 以 消除 系统 的 稳 态 误差。 根 
据 积分 增益 的 希望 变化 特性 ， 积 分 增益 参数 厂 的 变化 形状 如 图 7-19(e) 所 示 ， 其 非 线性 函数 
可 表示 为 : 





大 (ep(D) =Gi sechfciei(D) 《7.15)》 
式 中 ， 有 (ee(D)= asech(ciei(D) 为 正 实 常数 ， 三 的 取 值 范围 为 (0,a)， 当 er =0 时 ， 太 取 最 大 
值 。ci 的 取 值 决定 了 占 的 变化 快慢 程度 。 
非 线性 PID 调节 器 的 控制 输入 为 : 
de 人 


MD= 避 (GDDep(0+ 大 (ep(D) ao(Dd+ 和 (es(D,ev() 


直上 述 分 析 可 知 ， 如 果 非 线性 函数 中 的 各 项 参数 选择 适当 的 话 。 能 够 使 控制 系统 既 达 到 
响应 快 ， 又 无 超 调 现象 。 另 外 , 由 于 非 线性 PID 调节 器 中 的 增益 参数 能 够 随 控制 误差 而 变化 ， 
而 其 抗 千 扰 能 力也 较 常 规 线性 PRID 控制 强 。 避 居 ,如 变化 的 示意 图 如 图 7-19 所 示 。 























《7.167》 






































7.3.2 ”仿真 程序 及 分 析 


仿真 实例 
求 二 阶 传递 函数 的 阶 跃 响应 : 
133 

5 +255 

采用 离散 PID 进行 仿真 ， 采 样 时 间 为 lms 。 

取 S =1， 针 对 阶 跃 进行 仿真 ， 阶 跃 响 应 如 图 7-20 所 示 ， 其 中 列 , 天 ,如 随 偏差 CUWM =]D 的 
变化 曲线 如 图 7-21 所 示 ， 护 ,天 , 避 随时 间 (M = 2) 的 变化 曲线 如 图 7-22 所 示 ; 取 S=2， 针 
对 正弦 信号 进行 仿真 ， 正 弦 响 应 如 图 7-23 所 示 ; 其 中 力 太 ,后 随 炉 差 (M = D 的 变化 昌 线 如 


0] 


图 7-24 所 示 ， 和 名 洛 , 姑 随时 间 (M = 2) 的 变化 曲线 如 图 7-25 所 示 。 


GC9)= 

















5: 一 - 一 





Tinyout 





0 一 加 本 了 





0 0.2 0.8 1 


94imeG) 06 
图 7-20 阶 跃 响 应 〈《S=1》 
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饭 
局 
口 
口 
六 
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图 721 后, 大 , 允 随 偏 美 的 变化 曲线 CM-1》 














06- 一 一- -一 一 
0 9.2 0.4 0.6 0.8 1 


timets) 


图 7-22 Kb,55ta 随 时 间 的 变化 曲线 CM=2) 





1- - - 一 - 
人 0.8 1 





0.2 o4tmels) 06 
图 7-23 正弦 啊 应 1S=2) 
22.02 
22.01 
22 一 一 - 
-6.06 -0.04 -0.02 0 0.02 0.04 0.06 
0.85 
忆 
王 


立 


006 -004 -002 0 002 004 0.06 


1 一 一 
-006 -004 -0o2 0 002 0.04 ” 0.06 
error 


图 7-24 Ko 大 ka 随 偏差 的 变化 曲线 《M=1) 
2202 - -  - 
旦 220 


一 人 一 


站 02 0D4 06 08 了 


04 0 
timef) 
图 了 -25 各, 丰 :后 随 村 间 的 变 比 曲线 《Ca4=2) 
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从 仿真 结果 可 以 看 出 ， 避 ,扩大 的 变化 规律 符合 PID 控制 的 原理 ， 取 得 很 好 的 仿真 效 


仿真 程序 ，chap7_5.m。 
NOTILinear PID ContTrolL for a SerVo SYStem 
clear alli 


Close all1:; 


ts=9-0015 

J=17133) 

Ge=25/13317 

SYS=tf(tL1, [JS DO) 
dsys=c2d(sys,ts， 1 


[num,qen]=tfaataltdGsys， ev' 7 


z_1=07r_2=07 
D_L=07u_2=07 
Y_1=077-2=07 
error_1=07 
ei=07 

for k=1:1:1000 


上 time (kx) KxtS7 


8S=11: 

E S==1 久 Step Sigmal 
Tinfk)y=1.07 

elseif 8==2 多 Sine 和 igral 
Finfk)=1.0*sinf1x2xPirKx 世 Bl 7 


em 


youttk)=-den(2)*y_1-den(3)x*y_2+num(2)*u_ LI+num(3)xu 27 
error (k) =Frintk)-yeut (kz 


Gerror (k)=(error (K)-error_1) /ts7 


ap=22;bp=8.07cPp=0.87 
jp (k)=ap+bp*r (1-sechfcpxetrer(K) )》) 7 


ad=0.5;bd=2.5;:cdq=6.5;:QQ=0.30: 
kaqtk) =ag+bdyr (t+cdQxexpfddverror(k))) 7 


ai=1ici=11 
ktK)=aixsechtCixerror (K) ) 了 
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会 i=eI+eITTCE TIK)YES7 


(kJ=KP(K)*erIor (KRKI+KGIX)YQerIOT{K)+KT [Kx 所 7 


村 UPdase ParametLers 

rr_2=tr_1;r 1=rin(k)， 

u_2=u_l1)a_1=utk)i 

Y_2=y_1;y_1=yout (xl 
erroT_1=errortk)y 

ena 

figuret1) 7 

Plorttine riny kimey youty，k' 7 
xlabelt'timets) ;ylabe('rin your 1 
Eigure(217 

Plot (time,rin-yout，k') ylabell'error' 1 
X1labelt' timets)')7y1abel( error ) 7 
Eigurel3)7 

BDPlot{time, dcrror kk') 1 


X1labelf'timets)') ylabelt aerror 1 


M=I7 
让 M==1 
fignare1l4) 7 
SuPPJot (311) 
DBLOt (ertror,kPp,'K') ;xlabetl'error')7ylabelt' kbp' 7 
SubPP]orf312) 
Dlot (error,KkG,'K');Xlabe]l('error' ) 
adQ+bG/(1LI+cQ) 
SubpP1LCE (313) 


DLot (errer,kiy,k' ;xlLabel('error') jzrlabeli xi yz 





Jabetteka' 7 


忆 lset M== 

figure(S) 7 

SuUPP1ot (311j 7 

Blek(time,kP, kzxl1abelt'timetsl' )rylaneltkp' 7 
Subplot (332) 7 

Blor ttime,kd，'K')IXlabel('Llnelsj 1iYlLabe ( xG ) 1 
SubPplot {313) 

PILEime,ki， kxlabelt'timets) ) yylabelf' ki) 


ena 
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7.4 ”基于 重复 控制 补偿 的 高 精度 PiD 控制 


7.4.1 重复 控制 原理 


重复 控制 是 日 本 的 Inoue 十 1981 年 普 先 提 出 米 的 ， 用 于 伺服 系统 重复 轨迹 的 高 精度 控 
制 。 重 复 控制 之 所 以 能 提高 系统 跟踪 精度 ， 其 原理 米 源 上 内 模 原理 。 

机 到 被 控 对 象 的 输入 信号 除 偏差 佑 号 外 ， 还 至 加 了 一 个 “过 去 的 控制 集 差 ”， 该 篇 益 是 
上 一 局 期 该 时 刻 的 控制 仿 益 。 把 上 -次 运行 时 的 偶 差 反映 到 现在 ， 和 “现在 的 偏差” 一 起 加 
到 被 摔 对 象 进行 控制 ， 这 种 控制 方式 ， 俩 举重 复 被 使 用 ， 称 为 重复 控制 。 经 过 几 个 向 期 的 重 
复 控制 之 后 可 以 人 人 提 疝 系统 的 跟踪 精度 ， 改 善 系统 品质 。 这 种 控制 方法 不 仅 适用 于 跟踪 丑 
期 性 输入 信号 ， 也 可 以 抑制 周期 性 干扰 。 

在 重复 控制 中 ， 一 般 期 记 控制 作用 在 高 频段 的 增益 减 小 。 为 直 ， 在 重复 控制 中 经 常 
加 入 低 通 滤波 器 CCs) 。 木 控制 方法 取 ; 












] 
1+7as 
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QC) = 


式 中 ， >0 为 滤波 器 的 时 间 常 数 。 
重复 控制 信号 足 周 期 性 信号 ， 其 某 本 构造 如 岁 7-26 所 未 ，r 为 周期 参考 信和 号。 应 用 寻 
复 榨 制 不 仅 可 以 提高 系统 的 跟踪 精度 ， 还 可 以 提高 系统 的 鲁 棒 性 。 


过 去 信 吉 
ex- 。 
本 本 被 控 对 象 一 


图 7-26 重复 控制 系统 原理 图 


睫 


























7.4.2 基于 重复 控制 补偿 的 PID 控制 


基于 重复 控制 补偿 的 PID 控制 系统 框图 如 图 7-27 所 示 ， 其 中 rin 为 周期 参考 信号 ， 周 
期 为 工 ，upGeo) 为 PID 控制 的 输出 ， ue(b 为 草 复 控制 的 输出 。 











rm 1 up yout 


PiD 















































ne 

















图 7-27 ”基于 重 估 控制 补偿 的 PLD 控制 系统 框图 
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控制 算法 为 
M(1J 一 PC) 二 Ue( 有 ) (7.18) 


式 中 ，@s) 为 低 通 滤波 器 。 
由 Ce 天 构成 的 正 反馈 回路 为 Gr(z) ，elt( 旭 为 emror( 昌 经 过 C(z) 后 的 输出 ，ue(t) 为 ex 有 
经 过 Gr(z) 的 输出 。 




















7.43 仿真 程序 及 分 析 


仿真 实例 一 ， 采 用 M 语 计 进 行 仿真 


设 被 控 对 象 为 
50 


S(0.000046? +0.006s+ 
采样 时 间 为 fts=lms, 输入 指令 信号 为 一 个 正弦 信号 rin( 纹 =1.0sin(2rbD) ,其 中 频率 下 =1.0， 


幅 值 4=1.0， 则 信号 的 重复 周期 志 = 一 = 1000ms， 


GO = 









































开 、t 
低 通 滤波 回 选 取 : 
1 
29- 625 
PID 控制 算法 采用 FI 形式 ， 其 中 怠 =1.5, 乒 =10 。 重 复 控制 回路 中 PI 控制 算法 取 
各 =2 有 =1.0。 











取 M =1， 采 用 PID 控制 ， 位 置 跟踪 及 跟踪 误差 如 图 7-28 和 图 7-29 所 示 ， 取 M =2,， 采 
用 重复 +PID 控制 ， 位 置 跟 队 、 跟 踪 误差 及 控制 器 输出 如 图 7-30 一 图 7-32 所 示 。 
由 仿真 可 见 ， 采 用 重复 控制 补偿 的 PID 控制 可 显著 提高 跟踪 精度 。 
































2 4 人 
timef(s) 


图 7-28 PID 位 置 限 踪 CM=1) 
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fin,yout 














2 4timets) 5 8 可 
图 7-29 ”PID 位 置 跟踪 误差 

1.5 
1 
0.5 
0 
.05 
-1 
-1.5 

0 2 10 





4 timetfs) 6 
图 7-30 ”重复 拧 制 如 PID 位 置 跟踪 (M=2? 











4 timeks) 6 


图 7-31 位 置 归 踪 误差 








upP,ue 








-0. 150 -一 - 
2 4 timets) 6 8 


图 7-32 重复 控制 补偿 叫 的 控制 器 输出 up(K) 和 ue(8) 


仿真 程序 : chap7_6.m。 
8PID Control with Repetitive ConErol compemnsation 


ciear all;close al17; 


上 zs=0-0017 


SYS=LEti5sD0, [0O.00n0046,0.006, 1 0])7 





Qsys=c2Q1SYS，EB，Z 1) 
[numvsden] =cfqataltQsys，'V') 


Q=tff 人 [0.20, 了 jj) 7 针 FiLTLEGT 
QQ=c2d(tQtS，Z 7 
fnume ,GenQ]=tfdataltaQ，v')7 


F=]7 
对 = 了 /PRx] /ES7 


Z2Z=tt([1],，[1 zerost1,N)] ts) 7 
Qz=QQrz2Z1 


fnumz,Qenz]l=tfdataftaz， wy)7 


QGr=1711-Qz) 7 





y_1=01y_2=0iy_3=01 


ei=0zeil=07 
ue_1=0iue_2=0: 
ue_N-=0iue_N1=0rue_N2=0; 
c2_N=0;e2_N1-0;e2_N2-01 


e_N1=07: 


297 








人 2_1=D7 


for kxk=1:1:10000 
上 ime (K) =KxtS7 


工 in 其) = 工 .0Y*S 了 DEFK 了 r*DTw kr 七 全) 


Yout (Ki=-daen(2)*y_1-denit3)wy_2-Gcn(4)*y_3+mnum(2)*u_]+mnurmt3)xu_2+mum(4ysua 37 


etk) =rin(k)-yout (kj 


ei=ei+efk)xtSr 
UP(K)=1.-5*efK)+1OYeiy 


elfk)=-denQ@f2)*el_1+numQft2)xe_NI: 
eil=eilT+e1(Ky yw 七 S7 


e2(k)=2*el(ky+1.0Ox*reit: 


ue(k)=0.8187x*ue_1+0.1813*ue_N1L+e2(k)-0.8187*e2_1: 


sonly ustng PID 





uitk)=uek)+up(k): %Using REP+EID 


end 

荆 E K>N+1 
Ue_N1=uelftk-N-1) 
e2_N1=e2(K-N-1) 
E_N1L=etk-N-1) 

engq 

了 于 王 X>B+ 立 
ue_N2=ue(k-N-2) 7 
e2_N2=e2(K-N-2) 7 


enQ 
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用 Simulink 进行 仿真 





S 530 
CGI) 了 
xf0.00004657 + 0.0065+1) 
了 1 

和 Cs) = 

032x+1 00Ss+1 


用 PI 形式 ， 其 中 太 =1.5, 大 | =30 重复 控制 同 路 中 可 控制 算法 取 


员 蒜 如 了 疼 7-33 所 示 ， 采 用 重复 +PID 控制 ， 位 置 














=S0 ， 采 用 PID 控制 时 ， 位 置 j 
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图 了 到 重复 椒 制 补 俊 的 似 置 良 踪 误 舌 


仿真 程序 : chap7_7.mdl， 如 图 7-35 所 本 





Wi 广 放 | 
理 

一 忆 

要 抽 

we 了 | -| 证 -| 

交 下 | 风 
严 忆 要 站 玖 本 一 

一 末 

|。 3 


猎 工 35 基于 夏 复 控制 补 逮 的 PLD 控制 Simulink 程序 


7.5 基于 零 相差 前 馈 补 偿 的 PID 控制 


7.$.1 零 相 差 控制 原理 





的 跟 东 性 能 ， 拓 1? 
的 馈 控 制 环 节 设 计 成 竺 校正 的 闭 天 
为 非 最 小 相位 系统 时 ， 1 | 
疆 求 所 有 零点 都 在 单位 圆 之 内 。 离 数 系 统 的 剖 定性 要 求 所 环 系统 的 所 有 
> 肉 ， 由 不 变性 原理 ， 翡 最 小 相位 系统 的 不 稳定 零 吉 变 为 前 锁 控 制 监 的 极 
季 呈 不 稳定 的 。 在 实际 应 用 中 ， 随 着 采样 频率 的 提高 ， 很 多 最 小 相位 连续 系统 
离 航 化 后 所 得 的 离 艇 系统 为 非 最 小 相位 系统 。 零 相 着 【Zero Phase Error) 蝴 踪 
的 数字 式 前 饶 控 制 踊 尾 ” 利 过 在 前 镇 控制 兹 中 引入 零点 
， 在 指令 超前 值 为 已 知 时 ， 校 正 后 的 系统 在 全 顷 域 范围 内 相 移 





[if 


统 的 颍 带 ， 通 常 ， 前 
使 校正 后 






在 伺服 系统 设计 中 ， 前 馈 控 制 可 用 于 提高 
制 是 基于 不 变 必 站 
为 1， 但 当 闭 政 
谓 最 小 相位 
极点 必须 在 单位 加 
































1.36 所 示 食 单 输入 、 章 输 出 佬 环 PID 控制 系统 ， 设 Gu(z 二 ) 为 稳定 的 离散 对 象 ， 
j 化 而 得 ， Gulz-) 具 有 + 个 非 最 小 相位 零点 ， 其 静态 增益 
为 1， 则 Cltz 人 可 表示 为 : 
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ZNu(z DDN (z ID) 
D(z 
式 中 ，Wu(z) 7 十 而 z 十 人 十 到 2 关 0，Ni(z 包 含 了 G(z-) 中 所 有 位 于 单位 
上 及 单位 圆 外 的 不 稳定 宕 点 ， Na。(z) 包含 了 G.(z-0 中 所 有 位 于 单位 内 的 稳定 零点 。 

定理 1 设 王 (z )= Nu(DN(zD， 则 有 : 
(1 LUe 3)=0 vaeR 
(2) |Zaei 下 =Re[v ee hmlvece] vaeR 


G.(z)= (7.19) 









































了 十 下 由 
>~| PD Gh( 




















鲜 7-36 单 输入 、 单 输出 闭 所 PID 控制 系统 Ge(9) 


设 零 相 辩 前 馈 棕 制 器 为 : 
- -1 
到 CD = 三 NeCDOPG 1 《7.20) 
CO 
则 系统 的 实际 输出 为 : 
一 (s+G) 下 
y= 忆 (GDGsCTDrGE+S+= 三 一 人 CNaG zk+9+ 由 
AN 全 
假设 
7 一 1 
GD= 人 CsC ? (7.21) 
N。，(D 
显然 玉 (z-) 与 G(z”) 有 相同 的 频率 特性 。 由 定理 1 可 得 ， 
Ge-io)=0 VODER 玉 《7.22) 
GOD=l (7.23) 

















由 此 可 知 ， 如 果 理 想 输 出 超前 值 rK+D,…,r(K+d+5) 已 知 ， 则 系统 在 整个 频 域 范围 内 
相 移 为 过 ， 此 时 系统 的 输出 为 序列 世 &E -dh),A,r(EhAsr(E+s+d)} 的 移动 平均 值 。 





7.5.2 基于 零 相 差 前 锁 补 偿 的 PID 控制 


基于 零 相 差 前 馈 的 PID 控制 系统 如 图 7-37 所 示 ， 设 计 步 又 如 下 : 


GG 
intb jemorg 2 1 yout 
前 镇 控制 PTD 片 一 | Plant me 








ning 





























图 7-37 基于 零 相差 前 馈 的 PLD 控制 系统 结构 
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01) 可 频 测试 ， 得 到 闭环 系统 的 幅 频 、 相 频 特 性 。 
取 输 入 信号 为 正弦 信和 号 进行 闭 玉 PID 扫 频 测试 ， 测 量 不 同 频率 下 的 机 关 和 幅 差 。 
设 理想 输入 信号 为 : 


rin(t= Asin(2FD) (7.24) 
扫 频 测试 时 频率 可 取 为 ; 
下 = RNXR (7.25) 


式 中 ， 已 ,为 扫 频 初始 频率 ， 瑟 e 为 扫 频 步 长 。 
在 闭 琳 BID 控制 器 中 采用 P 控制 方法 ， 可 满足 闭环 正 入 位 置 跟踪 相差 和 幅 差 为 线性 ， 其 
控制 律 为 : 





e( 天 ) = Tin(K) 一 YOUL(K)》 
MK) 一 Ke( 引 二 如 (rin(K) 一 YOUTCK)) 《7.26) 
通过 扫 频 测试 ， 并 采用 最 小 一 乘法， 可 得 到 闭 剑 系统 在 各 个 频率 下 的 相 汰 和 幅 莽 .最 小 


二 乘法 的 原理 如 个 。 
设 参 考 信号 为 rin (E) = 4 sin( of) ， 当 系统 为 线性 时 ， 其 输出 角 位 置 可 表示 为 ， 


yout(g)= 由 sin(ot+)= 汕 cosgsin(o+A singbcosCot) 
册 cos 四 《7.277 
sin ? 
在 时 间 域 内 取 #= 0 六 2j ,rm， 其 中 必 =00012=1000 。 
设 ZT=[O (yi]j，c = hf cosg，cs =4rsinp， 且 有 : 
T -人 Sin(Cop) Sin(czj) | c728) 
cos(@0) cos(O 六 ) COs(CozP) 
则 可 以 求 出 cue 的 最 小 一 乘 解 为 : 


=[sin(or) cosCt)] | 





上 Gy 了 (7.29) 
从 而 得 刘 幅 频 和 相 频 特性 : 
了 了 
2 人 二 2 人 | 9 (7.30) 
mm 国 | 





(2)》 实现 闭 卫 系统 的 拟 合 ， 设 计 零 相差 控制 器 。 
利用 Boede 图 进行 拟 合 ， 可 得 到 闭环 控制 系统 的 传递 函数 G.(?， 通 过 零 相差 原理 


式 (7.19)》 一 式 (7.23)， 可 得 到 零 相 益 前 锁 控 制 器 。 
(3) 采用 霉 相 差 前 馈 探 制 ; 
error(K) 一 Finn( 天 ) 一 YOU 大) 
H 本 = 局 error( 扣 《7.31) 


式 中 ，rinn(k) 为 前 馈 控 制 器 的 输出 。 
7.5.3 ”仿真 程序 及 分 析 


被 控 对 象 为 一 阶 传 递 函 数 : 
“302" 


523500 
CO 35T10705 

系统 采样 时 间 为 lms 。 

分 为 三 个 阶段 进行 仿真 ， 分 别 由 扫 频 测试 (chap7_8_1.m)， 闭 趟 系统 拟 合 太 前 慎 控制 器 的 
设计 (chap7_8_2.m， 位 置 跟 踪 (chap7_8_3.m) 实 现 。 

《1) 频率 测试 。 

运行 程序 之 一 ， 即 扫 频 测试 程序 chap7_8_1.m。 

设 位置 跟 踪 信号 为 : 

Tin(K) 一 Asin(2TFD 

式 中 ，t= 杂 ,4=0.50。 初始 频率 取 局 = 0.50Hz ， 扫 籁 步 长 取 瓦 。 =0.50Hz ， 取 NE13， 即 
从 0.50 一 8.0Hz 进行 扫 频 。 

针 环 系统 采用 P 控制 器 ， 取 操 =7.0 。 通 过 扫 频 测试 ， 采 有 诈 最 小 二 乘法 求 得 闭环 系统 的 


幅 频 和 相 频 特性 ， 见 表 7-1。 





表 7-1 ， 扫 频 测试 结果 






























































CHz) 201g((4+A4)74jas AH ) 
0.50 -0.0133 -5.1368 
1.0 -0.0524 -10.2380 
1.5 -0.1152 -15.2706 
2.0 -0.1984 20.2064 
2.5 -0.2979 -25.0238 
3.0 -0.4087 -297087 
3.5 -0.5259 34.2545 
40 -0.6443 -38.6623 
435 -0.7588 -42.9394 
5.0 -0.8648 -47.0995 
55 -0.9579 -51.1614 
60 -10343 -35.1484 
65 -10905 -59.0884 
70 1234 -63.0135 
73 -11306 66.9606 

汪 8.0 -11099 -709717 








《2) 求 闭 环 系统 的 拟 合 传递 函数 ， 设 计 前 馈 控制 器 。 
运行 程序 之 二 ， 即 闭环 系统 拟 合 及 前 馈 控 制 器 设计 程序 chap7_8_2.m。 
根据 表 7.1 的 拉 频 数据 ， 采 用 MATLAB 冰 数 INVFREQS， 对 闭环 系统 传递 函数 进行 拟 





合 ， 
臣 ,4]=INVFREQS( 末 ,Pr,nb,na) (7.32) 
式 中 , nb 和 na 为 所 拟 合 的 传递 函数 分 子 与 分 攻 的 阶 数 , 瓦 为 在 频率 为 风 时 理想 的 频率 响应 ， 


互 和 4 为 拟 合 传递 函数 分 闻 与 分 母 的 系数 。 
版 na=3nb=1, 则 可 得 闭环 系统 的 拟 合 传递 序数 Ge(s) 为 : 
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-178s+3.664x105 
5S3+87.49s +1.029x1085+3.664x10” 
实际 闭环 系统 传递 函数 和 拟 合 传递 琢 数 sysx(s) 的 Bode 图 及 拟 合 误差 如 图 7-38 和 图 7-39 
所 示 ， 将 sysx(s) 离散 化 得 : 


Ce )= 





SYSX(KS) = 














-2.665x1035 zz +0.0002361z+ 0.0001411 





司 -2.906 世 +2.823z-0.9162 








magnitude approach(dB) 








phase approach(deg) 





10 
Frequency(radfsec) 


图 7-38 闭环 PID 控制 系统 Bode 图 拟 合 





error of phasetdeg] and magnitudetdE 
口 -~ 
1x 





20 30 40 
Frequency (radfsec) 
图 7-39 闭环 PID 控制 系统 Bode 图 拟 合 误 莽 


闭环 系统 拟 合 传递 函数 G.(z-) 的 零 极点 为 : 
42221164474527 0.97449754250883+ 0.08683973172465i 
Z= 0.561775711 | ， 呈 =| 0.97449754250883- 0.08683973172465i 
0.95720489476102 


可 见 ，G.(z 0 有 一 个 不 稳定 零点 z =9.4222116447452 ， 将 该 不 稳定 零点 转 为 闭环 系统 
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拟 合 传递 呆 数 的 极点 ， 从 而 形成 前 馈 控制 器 的 零点 ， 实 现 对 闭环 系统 的 不 稳定 零点 的 补偿 ， 
可 得 前 馈 控 制 器 瓦 (z) 为 : 
4984z# -1.501x104 +1.561X104 z2 - 6060z 二 484.7 
本 z+0.5618 

由 上 式 可 知 ， 理 想 的 前 馈 控制 入 要 知道 三 个 采样 周期 的 超前 信 。 考 虑 到 在 实际 控制 时 理 
想 输出 超前 值 不 知道 的 情况 ， 并 且 采 样 时 间 很 短 《lms)， 因 此 可 以 忽略 三 个 采样 周期 的 超前 
值 ， 则 实际 的 前 馈 控 制 器 为 ; 
4984 -1.501X104 z1+1.561X104 z2 - 6060z+484.7z14 

1+0.5618z” 





瓦 (zc ) 


PFC)= 
前 针 控 制 器 输出 为 : 
rinn(k) = 4984rin( 上 ) -1.501x104 rin(E -了 +1.561x104rin( -2)-6060rin(E - 3) 十 
484.7rin(K ~ 有 一 0.5618rinn( 开 一 1 
Gu.(z-DF(z-0) 的 Bode 图 如 图 7-40 所 示 ， 该 图 表明 在 一 定 频带 范围 内 ， 通 过 前 馈 控制 可 
保证 在 一 定 频带 范围 内 实现 输出 高 精度 跟踪 输入 。 























Bode Diagrams 
From: 00) 
下 

鲍 : 
中 
2 
入 
0 
一 
二 三 

演 -200 

_4og 间 _ 
1 10? 
Frequenoyfrad/seo) 


图 7-40 Getz5Ftz 的 Bode 图 


(3)》 稚 相 差 控制 器 的 验证 。 
取 采 样 时 间 为 lms， 输 入 指令 为 正弦 信号 
rn( 丰 =0.50sin(6rD) 


假设 超前 信号 已 知 ， 通 过 将 G.(z-) 玉 (z ) 最 小 化 并 进行 零 极 点 对 消 可 得 系统 的 输入 、 


输出 关系 为 : 
yout(K) = -0.1328rin( 大 + 2) +1.266rin( 大 十 1)- 0.1328rin( 大 ) 


假设 超前 信号 未 知 ， 对 输入 信号 取 三 个 采样 时 间 延 退 ， 通过 将 @(z- 7P(z ) 最 小 化 并 


进行 零 极点 对 消 可 得 系统 的 输入 、 输 出 关系 为 : 
yout( 天 ) = -0.1328rin( 大 - 上 十 .266rin( 大- 2) - 0.]328rnn( 天 -3) 


通过 上 述 输入 、 输 出 关系 可 以 对 零 相差 控制 器 进行 验证 ， 其 中 M =1 时 为 超前 信号 已 知 ， 
正弦 跟踪 结果 如 图 7.41 和 图 7-42 所 示 ;， 扩 = 2 时 为 超前 信号 未 知 ， 正 弦 女 踪 结果 如 图 7-43 
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和 疼 7-44 所 示 。 仿 真 结果 去 明 ， 当 超前 信号 术 知 时 ， 位 置 跟踪 性 能 下 降 ， 


06Fr- 下 
叫 











| 
1 
] 
0 0.5 ing) 1.5 2 


图 7-41 止 弦 跟 踪 CH=1) 





ermor 
忆 


-0.005 








上 
timefs) 


图 7-42 ”正弦 申 踪 误 盖 CH=1) 





0.6 一 - 


rinyout 








0 0.5 1.5 2 


1 
timeds》 
图 743 正弦 球 足 《4=2) 


.306 . 








吕 





可 
人 四 
.01 
-002. -一 
O 0.5 1.5 2 
timefs) 


图 7-44 正弦 邮 踪 误 着 (M=2) 
零 相 差 控 制 器 验证 程 逆 : chap7_8 0.m。 


&Zero DBhase Error ContreolLer Verfy 





位 1eaz 已 
ClLose 忆 TI 


ts=D.0017 


rin_5-0rrin_ 4=-0)rin_3=-0;rin_2=-0;rin_1=01 
F=37 

G=2000: 

for k=1:1:G 

time(k)=keLsi 
zietk)=9.50rsin(F*2xpiwkxLs)1 








ii M==1 
infk+3)=.50*8jinfF*23xrPIr{K+ 了 3) * 七 已) 了 
rinftk+2)=0.50xsinfPx2spiw tk+2)]xts) 7 
rin (tk+r1)=0-50xsin(Fx2xpiyr (x+1T)xtS) 1 
youk (KJ=-0.1328xrzn(kr2)+1.26byrintk+L)-0.1328xrintk) 7 

马 L1SeT M== 
yout (k) =-0.1328*rin_ 1+1-266xrin 2-0.1328xrin_ 31 


ena 


Tin_5=Trin_4;zrin_4=xin3zrin_ 3=zin 27rin 2=Tin_ 1;rin 1l=rintk)z 
en@ 

figuretl) 7 

Plot (timet1:1:G) rint1:1:G]) rozimetlsl:G),youc(l:1:G) bz 
Eigarel27》7 


Plot (tismelt1:13:G) ,zinl] :1:G) -Youtt]3:1:G)， 工 
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《4) 实现 位 置 跟踪 。 

运行 程序 之 寺 ， 即 位 置 跟踪 程序 chap7_8_3.m。 

采用 基于 及 相 差 前 馈 补 偿 的 PID 控制 进行 正 将 位 置 跟踪 ， 闭 环 仍 采 用 扫 频 时 的 控制 。 
当 $ =1 时 ， 输 入 指令 为 rin(=0.50sin(3rFt) ， 取 严 =3.0， 正 弦 位 置 跟踪 刀 图 7-45 所 示 。 当 
S=2 时 , 输入 指令 为 rn( 上 =0.50sin(2rfD)+1.0sin(6rl)+1.0sin(10ro),， 正弦 登 加 信号 位 置 跟踪 
如 莉 7-46 所 示 。 





rin,yoeut 





0 0.5 1 1.5 2 
tim efs) 


图 7-45 正弦 位 置 跟踪 《S=1) 





rin,yout 
口 








D 0.5 1.5 2 


timeG) 
图 7-46 由 弦 侣 加 信号 位 置 跟踪 〈S=-2) 
程序 之 一 : 扫 频 测试 chap7_8_l.m。 


&Zero Phagse Error Frequency testing 
clear all1; 


close all17 


七 S= 人 .0017 
sy8g=tt(5.235e005, [1,87.35,1.047e004,0]]1 
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dsys=c2dlsys,ts,'z'1i 


Imnum, cenjstfaaralasys， vi 


kp=0.307 
crror_1-=9) 


KK=0， SFTeGuencYy Steps 
Eor F=0.5:0.5:8 
KK=kk+17 


FF fkk] =F; 


D_l=0.07u_2=0.0ru_3=0.0; 





二 ime {tk) = 


gsTracing Sine Dhigh frequency Signal 


rintki=0-s*sintlx2rPiIrFxKkxtB] 


锡 Linear mcQeT 





wout (k)=-aen(2) xy_1-den13)*y_2-Gen(4)*y_3+numt2)*u_ 1 +Hmurmlt3) wu 2+Tmumt4)su 37 


Crror{Kk)=zintky-Yyout (k) 7 


UKk)=kp*error(Kk) 7 $%P ConErOITer 





=u_2;u_2=u_iru_l=ufk) : 


了 3-y-2i7_2=y-1II7_1-youb (sl7 
DPlot (time,Tin， rrime yout， 了 ) 7 
Pause10.00000000000011 1 
Y=rimt1001:1:2000) 1 
for i=1:1:1000 
faitl,ih = sin(2xpi*rPxistS)7 
fait2,i) = cos(2*pixFriwtSs)7 
engQ 


CO = nV( 下 记 i* 王 六) 下 己 计 7 


。 309 。 


BE2naA = SGqxzttcll)scltlI+cl2lxcl2)17 





etctL117 





二 全 inf2Y 外 ix 上 六 二 七 号 ] 


= cos(2x*PirF+YxtS) 17 





(人 村 避 ，) 二 下 ai 





poula = sqzctcllircll)+rcl2xrct2) 7 


PoutF = atrantcl2lycll)]y 


mag [xx =20Y1o91080POU 7 DT 辣子 委 MaGTiILUde 


PEtK<)= (PuF-DPinFyy1807P 和 Phase CTIOT 








mag=magl' 


ph=ph'， 


save freqma- FF mag Bhi 


Save Closed.rtat 





程序 之 二 :， 闭 玉 系 统 拟 合 及 前 馈 控 制 器 设计 chap7_8_2.m。 


委 忆 1 tem approaching anG zero pnase error controller daesign 





CTear 总 1 
CLOSE 7 


1oad frcoq.mat 1 











RDDO15 

T=FF: 

[or i=1:lengtnlph) 
Ti phtiysnD Bhtii=ph(i)-3607 
cng 

eng 


&%iYanesceyr funcricon apPLCOecring 
多 11)FTreo 可 DararmererS 
一 DY 和 FTCOm FEzZ 上 oO zaqy/seC 
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mag1=10, (mag/20) 7 %Frem 9B to Qegree 


Phl1=Phxpi/z1807 SFrom degree Lo raGian 


h=magl.x*costphl)+*jxmagl-xwsintphl) 


委 {(2)Continous funcr ion 

na=3; arTrhzee ranks apptroaching 

Pb=17 

&Dbb and aa are Leal numerator and qencminator of tramnsfer function 
[bb,aal=invfreqstnpy wmnbvnal gw _ contains the freguency values in Iaqiansy/7s 
aisplay(t'Transfer Eunction approaching is: ) 1; 

SySsx=5E{DDb,aa) 


[zsv,ps,ks|1=zbkdata(sysx，v') 1 


下 13)DiSCcete funcrion 

Ge=c2d(sysxvts，zoh') 

2zpxsys=zpktGcl 

1Lz,pykl1=zpkdatatzpksys,'v 1 ， S%GeLting zero-pole-gain: 2,DP, 上 
display('Zeros and Poles of the Transfer function is: ) 7 
提 

也 

&%In z-1 format 

zGc=tEtGcl7 

JnGc vaGc]=tfdata(zGc，Y 1 

zGc-filt tnGc,aects)7 


#{4)Magnitude and Phase to draw Bode 
$Frequency responseicreate the Complex frequency response Vector: h=arbi 
Pz=freqs(bb,aavmw)z 


S%MagIliLuade anq PhFase 


sysmag=abs tn) sDegree 
sysmagl=20*1ogl01sysmag)7 SFrom aegree to GDB 
sysph=anglethl ; 8Get Tal 





sysphl=sysphx180/pii SFrom radian to degree 


%(5)Drawing practical Plant and its approach funcbion Bode to compare 
Figuretl) 
subpior (2，1,1)7 


semi logx tw,sysmag1 ,ri ywvmag, bigria oni 





xlabell'brequency [rad/sec)') ;ylabelt'magnitude approachtSPB) 


SubPlioxr (2，1，217 
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semi iogx tw syEphl，rvw,ph vb' jpgrig on; 


xiabel UPreareney1raay secj')iylabel('phese apprcachtaegl 1 


figuret23 1 

magRTTCLI=SYSTmag1-Tmag 
Pharror=sysph1-ph; 

Plot (wphError，r' wmagErroz， 2 7 


xlabel requencyfradysec)') jylape-t'error of phaseftGeg) andg magnitudetaB) 1 


8(6) Plant ia zero-pole-qain format 
zu=z 1)  sUnscable zero point 
zl1=z12)7 

P1=P 

p114)=17zur 


kl1=1; 

Gctemp=zpk(z2 pl,kivLsli 
ac-acgaintGctemp) sGetting DC gain 
k1=17ac: SG(11=17 


Gcn=zpk(Z1L1,PL,K1LT,S) 


sl7)D5esign conLroller 

Fdz-1yGcnr aFaGz=2pK(D1,z1,EAKL,S) 7 
aisplayl'zPE Contrceller is: 11 
tfdz-tf(Faz) sz^(-3) three rank delay 


[an1l,aal]=ttaatatt+adaz，V 7 


nF=Imn17 

QF(21=GG1141 7 
qFIL2)1=adl15)7 
QFt3)=GQi it) 7 
QFtd4)=dg1(2) 17 
akil5)=adall3) 


8z^(-3) :three rank aelay 


sormat longy 

displiayf'zpPF Cont roller coefEiciert is: 3 
mnFP 

aF 


save 7zpecoeff.mat nF GF7 
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委 ContrO1j er 
F=EilctaF,dF,Esl， %BGual conversion:from z to z- 


qecsaintF) 7 


$18)Verity the SontroIl1er 
Cn=scricsitp Ooc) 7 &GmiIzJ=FIzJ*GCIz) 
ESguret3) 


bodGe {Gni 





inrealtGntLs)， ss3SimplinG Gntz) 





位 置 跟踪 chap7_8_3.m。 

8Zero Phase Error Posltion Control 

clear al1， 

close al1; 

loaad zpecocftf -rati S%ZFRE coefficient mnF ang dg 


load closeq.mat: 8Load KkP 


ts=0.0017 
SySs=tf(5.235e005, [1,87.35,1.047e004,.0]) 7 
Qsys=c2dfsys,LS，Z 0) 


[num,aen]=cfdaatatqsys，'v') 7 


Du_ti=0.07u 2=0-0;0_3=-0.07 


Trin_5=07rin 4=0;7rin_3=07rin 2=07rin_1=07 





F=37 
=21 
for x-1:1:2000 


七 ime (K) =X* 七 后) 


ES==1 
Tin(K}=0.50*sintFr2*DPi*kxrSs) 1 





elseilL[ S==2 8Random Sigmal 
rintk)=0.S0xsimt1x2xpix*kxtsl+l,Oxsinl3*2+pixkxrs)+1.0xSin(5*2xPiYXxtS)》 7 


end 


tinnt(kj=nF(L) kzintkl+nF(2)*Trin t+nF(3)*ria 2+nF(4) Tin 3+OER 15)*zin 4 


本 F (2)xIirci 


县 Linear meqe1l 
Youz ()=-dernl2)*y -aenf3)xy 2-dent4lxy_ 3+Ium(2)x2 Tinuam(3)xu 2+nurmt4)su 3 
erroriki=Tinmitkl-YourtKk) 


DI(K) =kPprcrrO(k1 7 SP ContrO1 






25n_1=utk) 


=rin_3irin_3=rin 2;rin 2=rin_ 1;rin_1=rinfk)， 


TDnn_1=Tjnntkyz 


y_3-y_237 27 _1i7_1-youttk)i 

enaq 

Eigureltll 7 

Blot (time,rin'r' rireyout，Db' 3 
xlabclt'Limels)') Yabe]l('rin,yout 7 
fgauret2) 

Blor (time rin-yout zi 


xlabel (timelsl') ;ylabell'error' 1 
7.6 基于 卡尔 曼 滤 波 串 的 PID 控制 


7.6.1 卡尔 受 滤 波 器 原理 


在 现代 随机 最 优 控制 和 随机 信和 号 处 理 技术 中 ， 信 号 和 喉 声 往往 是 多 维 目 平稳 随机 过 程 。 
因 其 时 变性 ， 功 率 谱 不 固定 .在 1960 年 初 提出 了 卡尔 曼 滤波 理论 ， 该 理 沦 采 用 时 域 上 的 递 扒 
算法 在 数字 计算 机 上 进行 数据 滤波 处 理 。 


对 于 离散 域 线 性 系统 : 
(= xD+B(R(K) 二 w(K))》 3 
Js)= Cx(EJ+YC) 
式 中 ，w(i) 为 过 程 噪声 信号 ，vw(6) 为 测量 噪声 信和 号。 
离散 卡尔 曼 滤 波 器 递 推算 法 为 : 
MOPOc (7.34) 
CP(DCT + 尽 
P(= 4PK-]D)4T+BCBT 《7.35) 
P(D= (MGODC)PCE (7.36) 
x( 拉 = xD+ag CE (O-C4arE-D) (7.37) 
了 0 一 CR) (7.38) 
误 状 的 协 方 准 为 : 
errcov( 届 =CP(EJCT (7.39) 


卡尔 曼 潍 波 顺 结构 如 网 7-47 所 示 。 
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， 卡尔 遇 
昌 DO->| 对 象 一 | 滤波 器 



































图 7-47 卡 处 曼 滤波 此 结构 


7.6.2 ”仿真 程序 及 分 析 


仿真 实例 

验证 卡尔 曼 滤 波 器 的 滤波 性 能 。 

对 象 为 一 阶 传递 函数 : 

133 

52 +255 

取 采 样 时 间 为 Ims， 采 用 Z 变换 将 对 象 离散 化 ， 并 描述 为 离散 状态 方程 的 形式 ; 
X(+]) = dx 大 十 器 (U(E) + (大 7 
CGOD=Cx(RD) 

此 有 测 显 品 声 的 被 控 对 象 输出 为 : 

也 (=CxUe)+wC 
1.0000000、 oo ， 盏 - [ss ，cC-=6ol，p= 四 





Gi(9)= 


0.0000000,0.9753099 |0.1313512 
仿真 方法 一 : 采用 M 语言 进行 仿真 
控制 干扰 信号 w(k) 和 测量 噪声 入 号 v(k) 幅 值 均 为 0.10 的 白 噪声 信号 ， 输 入 信号 幅 值 为 
10、 频 率 为 1.5Hz 的 正弦 信号 。 采 用 下 尔 曼 滤波 器 实现 信号 的 滤波 ， 取 @=1，R=1。 仿 真 时 
问 为 3s， 原 始 信号 及 党 有 噪声 的 原始 信 导 、 原 始 信号 及 滤波 后 的 信号 和 误差 苏 方差 的 变化 分 
蓝 如 网 7-48 一 图 7-50 所 示 。 仿真 结 果 表 明 ， 该 滤波 器 对 控制 干扰 和 测量 噪声 具有 很 好 的 滤波 
作用 。 


式 中 ， 4 

















05 1 15 了 25 3 
tmets) 


图 7-48 原始 信号 及 带 有 蝶 声 的 原始 信号 
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yrideal signak ye-filtered signal 








0.5 区 
timets) 


图 7-49 原始 信号 及 泪 波 后 的 信号 


2.5 


woL ~ 





Covariance of estimation error 








仿真 程序 : chap7.9.m。 


Kalindrl filter 
gxX=RAx+BIQ+W{K) ) 
&7=Cx+D+rV(kK) 
clear all17 


close al1i 


ts=D.099]7 
M=30D001 


革 Cont inuous Planb 
a=-2357b=1337 
SYS=tEfbv, [1,a,0])7 


Qsys=c2Q1sYS ,LS ZI 
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.1.5 
time(s) 
疼 7-50 误差 协 方 芝 的 变化 


2.5 


aoL 





[num, Genl1l>tEadatafQsys，V 1 


1L=[0O 170 -al17 


Bl1=-(0rb2 
CI=T1 0 
Dl=10]: 


[,B,C,D]=c2gm(aAl,BL,CLTD1I TS， ZE 1 


Q=l; $Covariances Df 史 

R=1; 8covaxriances of v 

PP=BxQrB : 多 TDitial error COVarjance 
x=zerosf2.1)17 aInitial condition on the etate 


Ye=Zercs (My 1) 7 


ycov=zerostMy 111 


U_1-03:b_2=05 





Y-1=07Y_2=07 


for K=1:I:M 


上 me {K) =K*fS) 


WUkly=0-19xrands(I) 7 多 PTDCESS PoOiSe on 





vtK)=0.10*randsft1) 7 SMeaSsuUrement noise On Y 


utK) =1.0vsint2xpiv1-5*+kwts) 
uk) =utxl)+rwtk)， 


ytkh=-aenl2)l*y_l-aen(3]J*y_2+num(2)*u_1+nuF(3)*u 27 


YVtK)=Yy (XI+VIOK) 


SMeasurenent update 
Mn=PxCrAICPAC +R) 
P=AxPx 呈 +B*QxB'7 
FE= (eyel2)-MnxC)*P; 


=AX+MDxr (YV{K) 一 CXRr*X) 


Ye(K) -Cxx+D7 $FI1TLered vailue 
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行 仿真 


上 抱 信 号 wk) 和 铀 量 噪 


仿真 方 
Kalman 






号 v(k) 幅 值 均 为 0.40 的 白 
曼 滤 波 器 实 了 的 小 





国 1 0、 箔 率 为 0SHz 让 站 
由 ， 取 CQE=1，R=1。， 仿真 时 间 为 10s， 仿 真 结 如 图 了 351 放 庆 52 所 未 








图 751 娩 信 号 y 肪 几 彼 后 的 信和 叶 )m 


* 了 318 * 





2 原始 信和 号 Y 
Simutink 主 程序 


带 有 叭 声 的 原始 f 
chap7_10.mdl 


仿真 程序 如 较 7-53 所 也 


Sne Wave 


- | 
7] 、 
更 ne1PAodmPBMn 7 wm 四 
和 一 
} 


ee 
ete Ste Spyct 

















区 中 



































ee 
居 Www 上 上 电 [ 
| 
一 上 -一 一 -一 -| 
芭 WO 
Rangeam “Saint 5 
Wemley 
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其 于 Kalman 起 访客 的 Simulink 仿真 
Kalman 填 波 子 程 序 :， chap7_10fm 


*3I9 * 





SYSs=Lftby Il,a,0])1 
alL=[0 170 -a]， 


B1=i0;b]:; 
Cl1=[l 0]7 
D1=TD]7> 


[有 ,BCD]=c2dm(a1,Bl,ClDlts， 2Z)7 


QQ=1T %Covariarces of ww 
有 RR=1， g#Covariances of 立 
P=Bx*Qx 忆 ' Initial error COVvariamnce 


end 


#Measurement Update 
Mn=PxC' AtCPYC1+R) 


x=RxX+Mnx (yYV-CrRxXx] 1 


BP= (eyel2) -MnxCh*P7 


Ye=CxXx+D7 gFiltereqd value 
QIIJ=Yez 
(2)=YV7 


errcov=CePxC' %Covariance of egtimacion error 


%Time update 
X= 有 <X+B*UDT7 


P=arP+R' +BxOxB 1 


波 器 的 PID 控制 





7.6.3 基于 卡尔 受 


基于 卡尔 曼 (Kalman) 滤波 器 的 PID 控制 系统 结构 如 图 7-54 所 示 。 





_ [三 卡尔 遇 
二 > OO 一 =| PID >| 被 入 对 象 | 一 了 入 =| 沽 波 吕 



































控制 干 挑 钢 量 噪声 ” 


yout 





图 7-54 ”基于 卡 水 曼 滤波 器 的 PITD 控制 系统 结构 
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7.6.4 仿真 程序 及 分 析 


仿真 实例 
采用 卡尔 曼 滤 波 器 的 PID 控制 。 
被 控 对 象 为 二 阶 传递 因 数 : 
133 
Ce 5 二 25s 


离散 化 结果 与 7.6.2 节 的 仿真 实例 相同 。 采 样 时 间 为 Ims。 

控制 干扰 信号 w(z) 和 测量 蝶 声 信号 w(j) 幅 倩 均 为 0.002 的 白喉 声 信号 ， 输 入 信和 号 为 一 阶 
路 信号。 采用 卡尔 曼 滤 波 器 实现 信号 的 滤波 ， 取 GE1，R-!， 仿真 时 间 为 18。 分 两 种 情况 进 
行 仿真 : M=1 时 为 木 加 滤波 ，MH=2 时 为 加 滤波 。 在 PID 控制 器 中 ， 取 
妃 =8.0 太 =0.80, 和 =020 。 加 入 滤波 器 前 后 BID 阶 路 响应 如 图 7-55 和 网 7-56 所 示 ， 仿 真 结 
果 表 明 ， 采 用 滤波 器 使 控制 效果 明显 改善 。 





14 .一 一 一 一 - -一 





0.4 06 08 1 
timefs》 


图 7-55 无 滤波 器 时 PID 控制 阶 跃 珊 应 (MH=1) 


1.4 -一 一 一 一 


nn,yeut 








0 02 04 06 ”08 1 
iimets) 


图 7-56 加 入 滤波 器 后 PID 控制 阶 跃 响应 《CaM=2) 
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仿真 程序 : chap7_1m。 


$Discrerc Kal>an 上 : 





er fox FID contzrol 
Reference Kalran_ 2ran< nm 
和 要 X= 六 X+ 王 (CUAWTK) 


x+D+ATK 





CIEaT 避 LT7 


CIose 17 


TS=D.D82 了 


8CorLinucus 三 -ant 





aa=257 
sys=cftb, [1,a ,0]11 
aoyb c26tsysvts，'z0)1 


Inumvaen] 





[Gatafasys，V 1) 








Pa=T0 150 -al1 

BEB1L=[87Dp] 1， 

cl-Il 0]1: 

Dl=L0]， 
[av,B,C,D]j=c2Gmtal,BzIC1,DP1tS， 2Z 1 
@=]; 8Covariances of W 


8%Covariances of V 





PS=BxQrB'7 sznicial error covatiance 


X=zexost2，117 千 Initial condicion on the state 





for K=1:41:1000 
Te (=K*tS7 





Finfk)= 
kp=S.Diki=D0.807kd-0.207 


wkK)=D,8D2*ranQsfI) 7 委 PTOCesgs moise cn U 


V(k) =0.002xrands Measuremnent noise on 交 








en(21*y_ 1-Qcn(3hxy_2+num(2)wn_1+namt3*u 27 





YvtgI=y krvtic)y 


$easurement Dpaabe 
KnrPxC' AGExC +rR)T 


ExrEPwR， 





BoxB，， 
F= (eyel2) -MD+C)sP 


xxxX+My (了 V1K) -CsawX) 7 





Yetk)=C*x+D; S$FilterecQ value 

=17 

ii SNor uslrg filtez 
Yout (KJ=YwLK) 1 

elseif M-=2 S$Using fiaxter 


Yeut (kK) yetk)7 
eng 
ertrotiIK)=Tintk)-yout(k) 


ei=ez4errorfk)xrS' 


tk) _kprerror(k)+kiweirkax(error tk)-error_1)vs SP1D 


utk)=utkl rwfK3 


exTCov(kK) =C*P+C 多 Covariance of es=inmarion error 


&Time upaate 


X-Rx*X+BxU (KK) 7 


1U_2=u_1;u_1=utk) 7 


1=YoOuL (K) 7 







=errOorX] 7 


figusrell) 17 
,ime ,youot，k' 7 
] 


ylabpelf In youc ) 1 


7.7” 单 级 倒立 摆 的 PID 控制 


Pocttimey cin， 





X1abelt' timet 





7.7.1 单 级 倒立 摆 建 模 
倒立 摆 系统 的 掠 制 问题 一 直 旦 控制 研究 由 的 一 个 典型 癌 题 。 控 制 的 月 标 是 通过 给 小 车 底 
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序 施加 一 个 力 x 《控制 量 )， 使 小 竺 停留 在 预定 的 位 置 ， 并 使 杆 不 倒 下 ， 邵 不 超过 一 个 预先 定 
义 好 的 牌 真 偏离 角度 范围 网 7-$7 为 一 级 倒立 抄 系 统 示意 图 ,小 车 质 量 为 对， 摆 的 质量 为 zm， 
小 车 位 置 为 x， 摆 的 角度 为 8 。 


由 


地 
lyGeao) 








亿 一 
4 | 寻 


可 | 





























俐 7-57 一 级 倒立 挫 系 统 示意 图 

设 把 杆 偏离 垂直 线 的 角度 为 6 ， 加 时 规定 换 杆 重心 的 坐标 为 (xc,ye) ， 则 有 有 : 
xa =x 二 isSin 晶 

ya =fcosB 
根据 牛顿 定律 ， 建 立 水 平 和 垂 贞 运 动 状态 方程 。 
皖 杆 围绕 其 重心 的 转动 运动 可 地 力矩 方程 来 描述 : 
三 =Vising 一 丈 cos8 
式 中 ，: 为 摊 村 围绕 其 重心 的 转动 民 量 。 

把 杆 重心 的 水 平和 运动 由 下 式 霸 述 : 














六 一 (x+lsin6)= 殖 
dr 


摆 杆 重心 的 垂直 运动 由 下 式 描述 : 








EcosB=V 一 m8 
di 
小 车 的 水 平 运动 由 下 式 描述 : 
MEzE-w 下 
dd 
假设 8 很 小 ，sin8 = 日 ，cosg=1。 则 以 上 各 式 变 为 : 
了 =VYBB- 环 《7.40) 
Pa(z+ 辽 )= 严 (7.41) 
0=VY 一 mg 《7.42) 
AGE =2&- 殖 (7.43) 
由 式 〈7.41) 和 式 〈7.43) 得 : 
COMH 二 mi+m = (7.44) 
由 式 〈7.40) 和 式 《〈7.42) 得 ; 
CH+PmEE=P8 要 《7.45) 


由 式 〈7.44) 和 式 〈7.45) 可 得 单 级 倒立 把 方 程 : 
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-mm+ 凤 )8L 8 PH 
一 了 一 本 于 
(89 十 IJ7TTaET (4 十 看 7 十 





《7.46) 


me28 有 2 二 了 十 mm 甩 
一 加 于 
(Ca +1i)7+aMoa (84+m7+Mnr2 





(7.47) 


控制 指标 共有 4 个 ， 即 单 级 倒立 摆 的 摆 角 6 、 氛 速 6 、 小 车 位 置 和 小 车 速度 站。 将 个 
立 把 运动 方程 转 化 为 状态 方程 的 形式 。 令 xD=6 ，x(2)=6，x(3)= 工 ，x(4)= 上 上 则 式 (7.46) 
和 式 〈7.47) 可 表示 为 状态 方程 式 〈7.48)， 











郊 = 4x 十 盏 5 (7.48) 
0 100 0 

式 中 ，A= 0000 ， 且 - 拉 | = Ha 十 邮 7)81  - 8 ， 
0001 0 (8 十 到 宁 士 MP (ad 十 mi)7 Ta 
000 丰 
2 了 十 PP 天 

一 如 





TI MT 


7.7.2 单 级 倒立 摆 控 制 
对 每 个 控制 日 标 才 挝 取 PD 控制 方式 ， 控 制 器 为 : 


忆 人 =Kei(t) 二 ddei(A (7.49) 
式 中 ，ei(6) 和 dei(5) 为 控制 指 标的 误 关 和 误 美 变化 率 。 





4 
MD= 6( (7.50) 


气 
为 了 进行 对 比 ， 采 用 最 优 控制 中 的 LQR 方法 。 该 方法 针对 状态 方程 = 4x+ 吾 &， 通 过 
确定 最 佳 控制 量 x( 六 = -Kx(t) 的 移 阵 大 ,使 得 控制 性 能 指标 .= | (cgQx+wRa)d 达到 极 小 ， 


其 中 @ 为 正定 或 半 正 定 )》 厄 米 特 或 实 对 称 矩 阵 ， 妥 为 下定 红 米 特 或 实 对 称 矩 阵 ，@ 和 巡 分 
别 玫 示 了 误差 和 能 量 损耗 的 相对 重要 性 ，@ 中 对 前 算 阵 的 各 个 元 素 分 别 代表 各 项 指标 误差 的 
相对 重要 性 。LQR 控制 器 的 增益 为 : 
下 =LQR(4,B.OQ,R) 《7.51) 
ax( 引 = 一 Er (7.52) 








7.7.3 ”仿真 程序 及 分 析 


仿真 中 倒立 近 的 参数 为 ，g = 9.8m/s2《〈 重 力 加 速度 )，M = 10kg (小 车 质量 )， 关 =0.kkg 
( 杆 的 质量 )， 工 =0Sm ( 杆 的 半 长 )， 太 =0.0005 (小 车 相对 于 导轨 的 摩擦 系 数 )， 
古 =0.000002 〈 杆 相对 于 小 车 的 摩擦 系 数 )。 正 为 作用 于 小 秆 上 的 力 ， 即 控制 器 的 输出 ， 在 
三 10+10] 上 连续 取 人 逢 。 

采样 周期 了 = 20ms ， 初 始 条 件 取 8(0) = -10-,6(0)=0，xO0)=0.20,z0O)=0， 期 望 状 态 
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为 : 8(D) =0,6(0)=0，xO = 0O=0， 其 中 摆动 佣 度 值 应 转变 为 弧度 值 . 

取 S$=1， 采 川 PID 控制 。 由 于 电机 控制 方向 必须 与 摆 的 倒 动人 角度 方 加 相反 ， 故 控制 器 
参数 选 负 数 , PID 控制 参数 选取 见 主 程序 .使 用 PID 时 倒立 摆 响 应 结果 及 控制 器 输出 如 图 7-58 
和 图 7-59 所 示 ， 可 见 ， 采 用 PID 控制 可 实现 单 级 倒立 择 的 控制 ， 们 PID 控制 器 的 参数 较 难 






































选取 。 
23| -一 -一 -一 一 
号 人 六- 一 人” 
-02- 一 -一 一 一- 一 一 - 
1 -5 0 一 后 -20 
it ”一 - 
四 
6 050 5 -1 一 1 20 
本 oO ”一 
囊 05 - -一 一 ”一 
10 -5 一 tn 45 -2 
四 
下 ov 一 一 一 
六 4 和 _- - 
如 5 10 15 20 
timets) 
图 7-58 采用 PID 倒立 摆 听 应 结果 《S=2) 
2 -一 一 一 - 一 -| 
腾 
-2 | 
四 
上 4 
。 
-8 
-0 - - 一 
0 5 19 15 2 
timetSs) 
图 7-59 PID 控制 点 的 输出 
1l00 0 0 0 
、 0 1000 机 
取 了 =2， 采 用 LQR 控制 , 取 &@ = oo19| 尺 =0.10,， 则 由 式 (7.517 可 得 LQR 
0 001 


控制 器 增 首 天 = (-64.0799,-14.2285, -3.1623,-6-6632) 。 

仿真 程序 由 中 部 分 组 成 : (1) 主 程序 chap7_12.ms (2) 子 程序 chap7_12fm。 

采 有 上 LQR 时 创立 搜 响 应 结果 及 控制 器 输出 如 网 7-60 和 图 7-61 所 示 ， 订 见 ， 采 用 LQR 
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可 实现 单 级 倒立 近 的 最 优 控制 。 


0.2 一- - 一 一 - 一 


Angle 
Angle rate 
局 已 
| 





二 

吕 05 

入 0 

关 | 

压 

避 

他 

芋 

妊 

竹 

避 

5 10 15 20 
timets) 


疯 7-60 采用 LQR 倒立 摆 响 应 结果 《3=1) 





Force 








0 5 10 15 20 
tmets) 


网 3-61 LQR 控制 器 的 输 岂 


土 程序 ，chap7_E2.m。 

sSingle Link Inverkted Pendulum Control 
CTLeaz 己 ]1 7 

clLese all7 

global a BC P 


&S2m91e Link LnverEead Pendujum FaramexrecrS 
g= 呈 .8 
HM=1.07 


m=0.37 
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EFc=0.00051 
Fp=n.0000902: 


I=1712*m*L^2: 

1=172*L1 

上 1=m* (M+m) xgx 了 /[(M+m)*I+Memx1l^2] 
上 2= -me2xgx1^27[ (mrM)*I+Mwrmy1^2] 
t3= -my1TAEIM+mhxI+Mem+l^2] 7 

上 4= 1I+mxIEe2) [tm+M) TI+Mxmy] 2]1 


aa=[0,1, 0 97 
t1,0,0,0; 
D,0,0.17 
L2,0,D0,0]7 

B=[D:t370;: 七 4] 7 


@=[100.0,0.0> $%100,10,1,1 express importance of 
吕 ,10,0,07 
D,0,1.03; 
9,0,0.]1; 

R=[0.1]7 

K=LQR (2,B,Q,R) 8LOR Gain 











el_i=07e2_1=0)1e3_1=0)e4_1=07 
UL=D7 
xk=[-10757.3,0,0.20,0]7 名 工 It 并 al SS 上 ace 





七 主 Ime (kK)》 一 大 * 丰 名 


Tspan=[QO SS11 


para=u_]; 
[t,x]=ode451'chap7_12f ,TsPan,xKk,[] ,Paral 了 
xk=xtlengLthfxl :7 


zlfk)j=0.0) spPendulum angle 
r2(k)-0.0; spPendualum angle Rate 
r3tk)=0.07 ， %car Position 


上 heta, Qthe 上 ta,Xx,Gx 


r4{tk)=0.0; SCar Pogsition Ratee 


X1(Kk)=xkf1)7 
X2 (KJ)=Xkft2)7 
x3tk)=xkf3)7 
X4{KJ=XK(4) 


el(K)=F1(Kk)-x1L{K) 
e2(K)=T21Kk)-Xx2fk) 
e3(K)=I3{K) -X3(K) 
4 (K)=T41K) -XUK) 


S%LQR 
utk)=K(LI)*el(k)+K(2)we2fK)+K(3)we3(K) 1IK(ST sed(K) 
elsejif S==2 针 PD 
ael tk) =el(k)-el_1， 
ul(k)=-S50*xeTtk)-1LOxdelftk) 
de2 (k) =e2(KkK)-e2_ 1 
u2 (KJ=-10*e2(ki-l0*qe2fk) 
ae3(Kk)=e3tk)-e3_17 
ua3(k)=-~L0xe3(K) -10*Qe3(K) 
Ge4(Kk)=ed4(k)-e4_ 1 
uatk)=-10*edtk)-10rded4fk) 
utk)=ultk)+ru2(kh+u3tkl+ud (kh 





end 


if ut(k)>=10 
utk)=107 

elseif u(k)<=-10 

utk)=-10: 
end 

cl1_1-e1tk); 

e2_1=e2(Kk) 1; 

e3_1=e3 (kj 

e4_1=ed(k) 

UL_1=uU(K) 
enq 
figuret1): 
subploet (411) 7 
Blotttime,rl，k' ime, xl ki #Pendulum Angie 
xlabelt'timets)')rylabelft'angle' ) 7 
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Subblo: (422) 7 


Pilot [tianeyr2， ieox2， KK 


Late Fimelsl')rylaoelfangle Tate' 


SubpietrtaL13)y7 


DPlotitimer3，'kKk' tinmeyX3， 


kk 


%Car Position 


xlabe- (cimelsl' jylabel('Cart pos:Lion') 7 


subplot (41411 
plor (和 





re 


gsCar Fosition 


X-~abeltl'timels) ;yl1abell' Cart rate') 1 


下 1 全 CRY 全 9) 了 


【 





plot 





XIakbelil' imelsi' jylapell Force' 7 


子 程序 : chap7_1 


PeruK" 


了 


2fm。 


[TuncLion qx=GYr tt Xi ES，BPara) 


gjobal 天 B CD 
=Baray 


Qx=zerosf4 1) 1， 


3Force F change 


省 State ecuaciox [or onae 1Lirck inverted Ponaulunm 


Gx=RxX+BwU7 


7.8 吊车 - 双 摆 系统 的 控制 


7.8.1 


吊车 - 双 摆 系统 的 建 模 


&Pemndualum argie RaLe 


实际 的 吊车 要 求 将 货物 尽 可 能 快 地 运送 到 目的 地 ， 并 在 移动 过 程 中 不 能 有 大 的 晃动 ， 这 
就 要 求 吊 车 在 移动 过 程 中 保持 上 下 摆 朋 平稳 而 且 小 车 本 身 义 要 达到 指定 的 位 置 ， 这 些 要 求 可 
通过 电机 的 控制 来 实现 ， 员 车 - 双 拨 系统 如 图 7-62 所 示 。 

娘 中 所 标 参 数 : ay 为 员 车 质量 ， 闸 为 上 摧 质 量 ，m 为 下 摆 质 量 :， 7 为 小 车 位 置 ， 甩 为 
下 摆 角 ;，C 为 上 摊 角 ;五 为 上 皖 杆 长 度 ; 五 为 下 皖 杆 长 庶 ， 严 为 拉 小 车 的 力 。 

通过 受 力 分 析 ， 进 行 线性 化 处 理 , 令 x=[x ia 放 有 记 ， 训 得 到 关于 小 车 、 上 摆 角 








下 摆 角 的 状态 方 种 ; 
0 1 0 0 0 
0 一 KeRKt 一 (十 ma) 0 0 
疏 a(Mrz 十) Mr + 了 7 
0 0 D 1 人 
=|0 一 攻 eKI 一 LE 十 中 十 Pi)r +J 了 8 0 2D8 
Ra(Mr2+J) (Mr2 + 了) 现 而 
0 0 0 0 站 
0 KeKt TCM + 四 +mjr + 0 二 C++bm+bna)8e 0 
RatMr > 二 .站 {Mtrz + 了 启 PE 
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0 0 
0 7KE 
Ra(Mr2 + 
0 0 
+ KRI | 
RafMr + 
1 0 


KE 
RatMr2 + 





昌 (7-S3)》 


忆 
己 品 避 避 一 忆 
已 口上 口 口 
二 一 串口 品 
一 局 牟 口 口 品 




















个 4 


疼 7-62 。 吊 盾 - 双 摆 系 统 


7.8.2 吊车 - 双 摆 系统 的 仿真 


取 某 吊车 - 双 捍 参数 为 52， 电机 负载 了 =1x10*kg.m2 ， 反 电势 系数 Ke=0.4758V.s ， 电 
槐 电阻 Ra=13.5Q ， 力 矩 系数 Kt= 0.0491kg.m/A ， 传 送 轮 半 径 >= 0.02276m ，m = 0.3kg ， 
mi =05kg，aMd =04kg ， =0.205m ，=0.156m 。 将 上 述 参 数 带 入 式 (7.33)， 可 得 实际 系 
统 的 状态 方 种 ; 





六 二 帮 大 十 加 于 
7 了 =Cx+ 了 有 9 


0 1 0 0 0 
0 -58.1558 -13.3099 0 0 0 
二 |9 0 1 0 0 
0 -73.7445 -112.7311 0 79.6748 0 
0 0 0 0 0 1 
0 73.7445 ”112.7311 0 一 247.1962 0 
100000 
010000 
有 =[ 948888 0 46275 0 -462737，c=l0D 0 1000,p=pooooop 
000100 
000010 
000001 


连续 系统 的 控制 器 采用 连续 系统 的 8 丽 数 来 实现 .在 $ 男 数 中 ， 只 采用 初始 化 和 输出 函 
数 ， 即 mdlInitializeSizes 函数 和 mdlOutputs 国 数 。 在 初始 化 中 采用 Sizes 结构 ， 园 择 1 个 输 
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出 7 个 输入 ， 
置 .在 给 出 中 实 了 


丸 序 叶 


前 6 个 输 


S=| 时 为 LQR 摊 









第 7 个 和 输入 为 小 车 的 目标 位 
2 时 为 PID 控制 .3 函数 嵌入 在 Simulink 








为 : DO) = MUi=U.a0)s12.60)=0.80=-12.80)=0.。 期 望 状态 为 ， 
tt0) 0.10, 0 =0.aO=OG0=0,BO)= BO=0O， 共 中 角度 为 弧度 单位 


在 Simulink { 





80 办 
和 ， 纺 度 通过 扳 度 值 狐 以 2 以 度 的 形式 表示 ， 仿 真 程序 由 三 部 分 


硼 成 , (1) 于 程序 chap7_I3m 12) Simulnk 程序 chap7_13sim.mdl (3) 3 表 致 笠 序 chap7_13s-m 
11000 0 1 人 0 1 
人 0 1 1 站 人 


ff IO0O0 0 有 0 
取 S=1, 采用 LQR 扩 制 , 取 C= 


只 ”如 / 生 ^ 帮 73900) 用 





, 小 车 目标 位 置 为 R=0.40， 


T0 人 1 


则 由 武 (351) 可 笠 LQR 控 







增益 太 = 1100.1.0379.32.6938.3.0696.-48.7526.0.6557) 。 小 革 
68 所 示 。 可 了 凤 ， 采 玫 LOQR 可 实现 吊车 - 双 摆 的 最 优 控制 

数 选 取 见 主 笠 序 响应 的 仿真 为 例 ， 其 响应 
> 制 





图 763 小 车 位 置 响 应 





图 7.64 小 汞 速度 响 所 


阳 7.65 


图 7- 


图 T67 


图 7-68 





上 控 有 角 角 度 响 庶 





上 探 角 生 速 度 响 诬 





下 摆 人 角 角 上 度 响 





下 摆 朋 区 速度 啊 启 


We 


ne] 





疼 7.69， 小 车 位 置 响 遍 


程序 。chap7_13.m 
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Simulink 程序 ，chap7_13simmdl， 如 网 7.70 所 示 。 






































































































































| 关 - 记 
| 三 
让 1 
症 固 
村 闪 
下 汪 | 
em 二 
上 描 角 
| | 吕 
LT 
上 鬼 志 宗 妥 1 
本 “ ER 
若 | 
下 洗 坎 密度 2 
下 [| 
eaim 下 所 角 


网 7-70“ 昨 车 - 双 扫 的 Simuiink 仿 点 模块 


S 琐 数 程序 : chap7_13s.m。 
多 S-functiocon for corntinuous 8State CGuat1oc 


cancrion sys,x0,Strits]=s_functjontt, xuvf1agl 


Switch flag， 


本 IEit iuIi2zation 


Tsygsyx0, str,ts]=mal-ni=iaizeSzesr 
SOu<Puts 
Case 3vr 


SYS=ImGLOuEPutS (t ,Xu) 7 





8Unnanaled 上 Tags 
Case f{1，2，4，3 1】 
SYS = []; 
UnexpPpecceqd fl1ags 
Otherwise 
ertorf['Unhandled flag = ,num2stLrIf1ag+])7 


eng 


条 md ID is 并 Ze 六 iZe 台 
function [sys,x0o,sLr,Es)=malInitializeSi2e5 


Sizes = Slimsizcsy 
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sizes.-NumContStates = 107 
Sizes.NumDiscStates = 07 
Sizes ,NumOutDputs = 1 
sizes.NumInputs = 7; 
sizes.DirFeedthrough =- 0; 


sizes.NumSampleTimes =- 07 


sys=simsizes(sizes); 
X0=[]7 
Str=[] 1; 
ts=[]7 


smqdl1Outputs 
function sys=mdlOutputs (t,xvu) 
global 
=17 
if S==1 
sys=-Kx[ufl)-ul3),ult2),ut3),uf4a),uf5)vul6)] 7 8LQR 
elseif S==2 


sys=50* (ul7)-ut1))+l0*{0-ut2))+l0*(0-ul3))+i0*(0-u(4))-10*(0-u(5))+LO*(0-ut6) 
) 1 3PID 


ena 


7.9 基于 Anti-windup 的 PID 控制 


7.9.1 Anti-windup 的 基本 原理 


任何 实际 的 控制 系统 都 包含 饱和 非 线性 特性 。 控 制 器 的 Windup 问题 一 般 被 认为 是 当 控 
制 器 输出 上 和 输入 们 之 间 存 在 非 线性 特 竹 NO 时 , 产生 于 控制 器 PIPID 积分 部 分 的 一 种 不 良 
现象 。 

饱和 特性 对 实际 系统 的 影响 十 分 严重 。 由 于 在 系统 调试 过 程 中 大 都 以 小 信号 作为 系统 的 
调试 信号 ， 所 以 造成 设计 者 对 饱和 特性 非 线性 的 认识 不 足 而 忽略 了 它 的 存在 。 在 实际 过 程 
中 ， 当 有 大 信号 输入 或 其 他 情况 使 控制 系统 进入 饱和 状态 时 ， 系 统 的 性 能 会 产生 较 大 的 降 
低 ， 不 能 满足 性 能 的 要 求 。 因 混 ， 引 入 适当 的 补偿 环节 ， 使 控制 系统 在 出 现 饱 和 现象 时 仍 
能 达到 比较 满意 的 性 能 指标 的 Anti-windup 设计 技术 成 为 进行 具有 饱和 特性 的 控制 系统 设 
计 的 基本 思路 。 

在 参考 文献 [29] 中 针对 积分 Windup 现象 ， 提 出 了 一 种 变 结构 PID 控制 器 ， 其 结构 如 
图 7-71 所 示 。 
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几 7-71 基于 Anti-windup 的 PID 控制 器 结构 
当 控制 器 输出 信号 饱和 时 , 饱和 误差 项 为 如 ~&,， 采 用 系数 好 实现 积分 项 的 自 适 应 调整 。 
红 的 自 适 应 变化 律 为 ， 
六 二 一 二) 天 加 tiele 一 雹 )> 0 三 = 人 mn 十 Hua ]/2 
e 


《7.54) 








式 中 ，aw >0。 
7.9.2 ”仿真 程序 及 分 析 


仿真 实例 
设 被 控 对 象 为 ; | 
人 +256 = 1337 

指令 为 一 个 大 的 阶 跃 信号 1500。 分 别 采 用 控制 器 式 〈7.54) 和 传统 PID 进行 仿真 。 当 
M-1 时 为 Anti-windup 的 PID 控制 ， 当 M=2 时 为 传统 PID 控制 。 仿 真 方法 分 为 以 下 两 种 。 

仿真 方法 一 

针对 连续 系统 ， 采 用 离散 控制 器 进行 仿真 ， 采 样 时 间 为 1s8， 取 w=1.0， 避 =0.10， 
瑟 =0.01 ， 台 =0.01， 控 制 器 输出 信号 的 范围 为 0 一 10。 

仿真 结果 如 图 7-72 一 图 7-75 所 示 。 



































1500 广 
10c0 
与 
马 
六 
全 | 
三 | 
500| 3 
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time(s) 
疼 7-72 基于 Anti-windup 方法 的 PID 阶 跃 响应 CNM=D 


"337。 


cortrol input 





站 50 100 150 200 250 300 
timets) 


图 7-73 基于 Anti-windup 方法 的 控制 路 输出 


3000 一 -一 一 一 一 一 





0 - 
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timets) 


图 7-74 基于 传统 PID 的 阶 跃 响 应 (AMW=2) 


control input 





0 50 100 


150 200 250 300 
imefs) 


图 7-75 ”传统 PID 方法 的 控制 器 输出 
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仿真 程序 :chap7_14.m。 





&Discrere PID con=1cl 





WiLh PaLI-w22aduE 
CTLeaE 可- 上 了 


Close all7 


XK=ZeTOS 12 二) 让 








1:3800 
上 ime {K)=kxLS 7 





Tintk 5001 


一 -1 


SPar- 0 te 





az 





上 有 PaDy XXX [ ，D 二 工 二 





,ax .=oaed45f chap7_ 





XK=XX[1enGEh{RX) 了 





yout (5 -xx(l7 


elxl=TrIIK)-Ycurfk)7 


efK) = 《el 的 1 -人 TS 


untK)=kpxefk)1kircirkqrae(Kk) > 


uSIKTswnCK) 


人 KJ =umax 





区 = umax7 
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us (K)=urminy 


em 


es (KK)=us(k)-untk) 7 


M=17 
Switch M 
Cas 会 二 刍 VSPID 
Dalkj=(umax+urminm] 7 
if un(kj~=us(k)getk)*r(tunlk)-ua(x))>0 
ef(k)=-alfaxtun(K) -us(K)) Xi7 


else 
ef(k)=etk) 
eng 
case 2 SNo Anbi-w:nauP 


efE(k)=etk)7 
enaq 


ei=ei+ef(k)xts7 


D_I=ust(K) 

e_l=efkj 

ena 

figuret1) 7 

plot (time, rin rrvtimev youc pb) 
xlabel('timetSs)') ,ylabellt'ricyout ) 7 
fiSgurel2) 7 

plottcime,us，r'); 


X1abelt'timets) ylabeil'control :input ') 了 


被 控 对 象 子 程序 :chap7_14fm。 
function Gdx=PlantMoedel {t ,xf lag,Para) 
Gx=zeros (2,1) 7 


U=parai 


Gxt1)=x(2)7 
Gx(2)=-25*XI2]+133xU7 


仿真 方法 二 
针对 连续 系统 , 采用 Simulink 方式 进行 连续 控制 器 的 仿真 , 取 C= 1.0， 后 =50 , 厂 =10， 
太 =1， 控 制 器 输出 信号 的 范围 为 0 一 10。 仿 真 结果 如 网 7-76 一 图 7-79 所 示 。 
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图 7-76 于 于 Anti-windop | 








于 传统 MD 的 阶 收 叮 ) 
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图 了 79 传统 PLD 让 流 的 扩 机 


仿 南 程 序 的 Simulink 主 程序 ，chap7_15.mdl， 如 针 7-80 所 下 





所 7.80 Armi-wingup 的 Simulink 仿 艳 程 放 


初始 化 程序 :chap7_15fm 
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aaX= 工 2 
Ua= tarmimiurmaxyy217 


af 函数 了 程序 ，chap7_15m.m， 


Eurctien lul=Pia_awratlrul, za2u3，241 


=u27 





M-11 
SWITCH 


是 FID 


emE-wircgap EID 





umax=107 
ua=tuminrumaxjy7217 


US&Rer* (fu 一 JRa)>D 





7.10 基于 PD 增益 自 适应 调节 的 模型 参考 自 适 应 控制 


7.10.1 控制 器 的 设计 


设 被 控 对 象 为 : 

日 +ong6+ao8 = Boe 《7.53) 
h，6 为 系统 输出 转角 ，2 为 控制 输入 ，ao 、 ex 为 非 负 的 实数 ， 为 正 实数。 
定义 参考 模型 为 : 

包 +al6 +aoBn = 贡 (7.56) 
hh，6,。 为 模型 输出 ，” 为 系统 指令 输入 ，ao 、al ， 忆 为 下 实效 。 
定义 误 养 信号 为 : 





e=6n-B (7.57) 
由 式 〈7.55) 一 式 (7.57)， 得 到 误 答 动 态 方程 如 下 
EHae+ae= 厅 -Bu+ 人 -oj6+(o 一 ao)8 (7.58) 
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定义 BE=[ 区 引 : ， 则 得 到 误差 状态 方程 如 下 ; 


e=4B 0 十 9 《 
= 上 8 一 | 民 
有 了 1 了 .59》 
式 由 ，4-or+O abr we， 4 9 1 上 
一 ep 一 纪 


由 于 犯 阵 4 的 特征 值 上 共有 负 实 郭 ， 所 以 式 〈7.59) 趟 示 的 模 嵌 昆 稳定 的 。 则 存在 正 守 第 
阵 瑟 和 名 ， 使 得 下 式 成 立 : 
4P+R=-Q@ (7.60) 
在 参考 文献 [43j 中 ， 以 PD 形式 定义 控制 项 人 为 : 


E= Pie+ Pa2e 《7.61) 
式 中 ，[p， 户 ]=@ je。 
在 参与 文献 [441 趾 ， 设 计 自 适应 控制 很 为 : 


二 天 Or 十 BTK28 (7.62) 
=Moir 《7.63) 
丰 = 2 (7-64) 
人 = 26 (7.65) 


7.10.2 稳定 性 分 析 


设计 Lyapunov 抽 邹 为: 


他 -Rh 寺 直 他- + 名- 《66) 





] 
V= 一 ETPE+ 


1 
2 2 
对 VY 取 导数 ， 出 于 


ee] = Je +P4je :| 一 Bu) 
劣 坊 到 式 〈7.60)， 电 有 
ec 小 1jPe=e 

则 

Yergerel-R)- 入 总 6-Ru 六 R J)- 生 包 -wa-Bi) 
将 4 和 zz 代入 上 式 ， 得 : 

24-Boo0)=2r 也 -Bio)+eelo-a-pBb)+esCa -ai 一 po) 

则 
-eroe+|a- 站 |p-Rs|se- 丰 au-a-Bi| 5- 在]a-a-Bi) 

2 加 如 刀 
将 式 (7.63) 一式 〈7.65) 代入 ， 得 : 

Y= 了 er0e<0 
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7.10.3 仿真 程序 及 分 析 


仿真 实例 
设 被 控制 对 象 为: 

日 +206 +259 = 133u 
参 号 异 肌 为 : 


站 +206。+306。= 50r 


指令 们 品 分 两 种 ， 阁 3S=1 时 为 方 波 ， 当 S=2 时 为 正弦 。 取 3=1， 即 指令 信号 为 方 波 ， 控 


0 
制 器 参数 取 1 = 为 = 和 =200， 到 @-| 划 - 


仿真 过 程 中 ， 被 探 村 象 初始 状态 地 为 10,， 外， 参考 模型 初始 状态 取 为 10，0 


已 ,2 的 初始 状态 取 为 [0，0，， 
仿 基 
辫 7-83 为 控制 器 笨 ! 





， 自 适应 参数 


沾 采 如 图 7-81 一 网 7-84 所 示 ， 岁 7-81 利 网 ?7-82 为 参 革 模 刚 倍 畦 跟 距 及 跟踪 认 差 ， 
上， 图 7-84 为 控制 器 参数 局 ,大 ,as 的 白 下 应 变化 过 程 。 





2 - 一- - 
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Timets) 
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四 
权 | 
上 2 | 
5 ] 
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-1 - 站 
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30 
Timets) 
交 7-82 位 置 婴 踪 误 疼 
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Control input 
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0 


10 20 30 40 50 60 
Timets) 


疼 7-83 ”控制 点 输 出 信号 

















0 加 20 


30 
Timets) 

图 ?7.84 Ko ,KK 的 变化 过 程 
主 程序 ， chap7_16.m。 
&aAaqaprlve Robpust CaorbHrol Rasee om PD Term 
CTeaT La 
close Bl1L7; 


Goba， 三 


十 S=D .DO817 


TimeSel=[D:ts:60) 1 


DO=307 
aaL=207 
Db-50 
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er=10 5.a0， al 
Gaiggarm) 
sQ-720,.070,20]; 
CQ= .2n0,:8710,20]; 


E-Jyapftaem oli 
Pl2=P(1,2)7 
=bt2DP)7 





了 P2 
Paxra= al,aug,b,Ppl2,P22]7 





Qed5S 
,5) 1 
K1-Yyeut (6)7 
k2=yosrt3v 7 


foJE 09n08g， nopara)7 





Ko=wout 


SewrILca 号 
Case 工 


DODw 二 > 了 xDT) gsSqQuare Semal 





Case 2 


I=1.0*sint 二 -0*tw2xpi) 7 





endq 


U=kG.xrkl.wyDuti3y31+K2.xYeet(3 4117 


计 igurctT}F 





Dotr tt ,Yecac 1) KULryouLti 3) KK 


X1apelft'Jimels)' jylabell'Positjor Leackino' 





figuret23， 
PoLIEYD2E( 1L)-YCaE tr3) KK 


;ylabpelt'Position cracking error' 7 





TIgure 3 
ploEfE uk 
x]abelf'Timets)')iy2abelft Contrcl inPut') 7 


figuretd3 
SUPP1oL 3 1 
DPloet (fkQO，k 
XeabPeli' Timels) Yabe]f KS ) 
subplor (3,1,211 
EBPILOE (FE kK] KK) 
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Xlabei iTinetsi' yyy1abe-0kTO)7 
Subplozt3y 1 317 
BloE IE K2，K17 





xlapelf Timefs 





79aDcelfK2 1 
子 程序 :chap7_16eq.m。 
:unctacn ay=pynar -ckoce: ty， 
global 8 
dy=zeros(1 -11 








多 Sace 三 igmial 


gsSjnm 8jgla7 





已 ] = 了 aa 双人 


agO=Pparal2) 1 
Pb=parat3i1 
312-paratd4)i 
D22=paral5): 


e=yfl)-YI317 
de-y(2)-Y1d4) 1 


es=Pp-2xerp22xGel 


KO0=Y (51 7 
K1I=YfE)7 
Kk2=Y(717 
=kKO*EHKTLAY 13)+K2YY GT 


Qytz)y=yY(3)》 
ay(2)1=Dpxrr-al*yl21-agryf1)17 


yt3]=YIS) 
ay(a)=-25wy 131-20xy(4)r133*ui 


Qyit51=200*cH*E7 当 KO 
Gy (61-2007eRwf3) 允 XKT 
Gyt7)=200xeF*y(4) 多 人 
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第 8 章 灰色 了 PID 控制 


8.1 灰色 控制 原理 


部 分 信息 已 知 、 部 分 信息 森 知 的 系统 为 基色 系统 .灰色 蔬 测 是 用 灰色 模型 GMA4,A) 进 
行 的 定量 预测 ， 灰 色 控制 基 指 对 本 征 特性 灰色 系统 的 控制 ， 或 系统 中 含 藉 参数 的 控制 ， 或 用 
GM(M .N) 购 成 的 据 测控 制 。 


8.1.1 生成 数列 


1. 累加 生成 (Accumulated Generating Operation，AGO) 
如 果 台 一 中 原始 数 询 ， 第 一 个 维持 不 变 ， 第 二 个 数据 十 原 始 的 第 个 加 第 一 个 数据 ， 第 
三 个 数据 足 诛 始 的 第 :个 、 第 -- 个 与 第 三 个 相 加 …… 这 样 得 到 的 新 数列 ， 称 为 累加 牛 成 数 你， 
这 种 处 理 方式 称 为 累加 生成 . 
基本 公式 : 
的 = 吉 xmd 《8.1) 


x0( 人 =xOK-D+xe CD (8.2》 
累加 生成 是 使 任意 非 负 序列 、 择 动 的 与 非 氛 动 的 数据 转化 为 目 减 的 、 递 增 的 数据 。 
没有 规律 的 原始 数据 ， 经 时 加 生成 后 ， 如 果 能 得 到 较 强 的 规律 ， 并 旦 接近 某 一 孙 数 ， 则 

该 函数 称 为 乍 成 秀 数 。 生 成 琐 数 就 是 一 种 模型 ， 称 为 生成 模型 。 通 过 紧 加 获得 的 模型 称 为 累 
如 生成 模型 。 


2 累 减 生 成 


昧 减 咎 成 是 指 将 原始 数列 前 后 两 个 数据 香 减 所 得 的 数据 ， 累 减 生成 是 岂 加 生成 的 道 运 
算 ， 简 记 为 IAGO(inverse Aceumulated Generating Operatiom)。 累 减 到 算 可 将 累加 生成 还 原 为 
非 生 成 数列 ， 在 建 模 过 程 中 用 来 获得 增 量 信息 ， 





基本 公式 : 
ax -xn(6 
Cn 二 Cr2H(K 
Qt 有 =< (0 3) 
amongO)= xc 
ax =xo 0 
换算 公式 : 
(8.4) 


xD=xoO(-x0 -yy 
om 有 =xn(OxO(E-D 
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8.1.2 GM 模型 


GM 模型 灰色 异型 《Grey Modei)， - 般 建 模 是 骨 数 据 列 建立 苋 分 方 种: 灰色 建 模 则 足 
用 始 数据 获知 生成 后 建立 微分 方程 、 中 于 系统 被 噪 上 污 染 后 ， 所 以 席 始 数列 呈现 出 离 乱 的 
情况 。 离 乱 的 数列 郎 灰色 数列 ， 或 者 灵 色 过 程 ， 对 灰色 过 程 建 立 的 模型 ， 便 称 为 亦 色 模型 。 

菊 色 系统 地 论 〈 也 品 称 为 炙 色 理论 ) 其 所 以 能 够 建立 微分 方 种 的 模 地 ,是 基 于 下 述 概念 、 
观点 、 方 式 和 方法 ; 

(1)》 灰色 理论 将 随机 晤 当做 是 在 - 定 范 国 内 变化 的 灰色 量 ， 将 陨 机 过 程 当 仙 是 在 一 定 范 
国 、 一 定时 区 内 变化 前 灰色 过 程 ， 

(2》 灰色 理论 将 无 规律 的 原始 数据 经 生成 乒 ， 使 其 变 为 较 有 规律 的 生成 数列 《通过 数列 
间 各 时 刻 数据 的 逐个 加 加 以 得 色 新 的 数据 和 数 询 ， 尝 加 前 的 数列 称 为 原始 数列 ， 累 加 后 的 数 
列 称 为 生成 数列 ， 记 为 AGO) 再 建 模 。 所 以 灰色 建 异 实际 .于 是 乍 成 数列 模型 。 

(3) 灰色 坤 论 按 开 集 丘 扑 定义 了 数列 的 时 间 测 度 ， 进 而 定义 信息 深度， 定义 藉 导 数 与 灰 
微分 方程 。 

(4)》 灰色 理论 道 过 灰 数 的 不 同 生成 方式 、 数 据 的 不 同 取 含 、 不 同 级 别 的 减 差 GM 模型 来 
调整 、 修 正 、 提 高 精度 。 战 差 是 模 出 计算 仁 与 实际 值 之 将。 

(5) 灰色 理论 的 模型 在 考虑 残 兰 GM 模型 的 补充 和 修正 后 ， 变 成 了 养分 、 微 分 方程。 

(6) 灰色 理论 的 模 用 选择 是 基于 关 眉 度 的 概念 和 关联 度 收 化 原理 ， 关 腾 度 收敛 是 一 种 有 
限 范 围 近似 的 收 敏 。 

《7》 灰色 GM 模 煤 -- 般 来 几 三 种 检验 ， 即 喊 兰 人 小 〈 或 平均 值 、 或 最 近 一 个 数据 的 残 闫 
仁 ) 的 检验 、 关 联 度 检验 、 后 验 养 检验 。 残 符 人 小 的 
型 与 指定 函数 之 间 近 似 性 的 检验 ， 捷 全 验 。 

(8) 对 高 阶 系 统 建 模 ， 灰色 坦 论 足 通过 GM(4， AN 模型 群 解 关 的 。 GM 模型 群 即 一 阶 微 
分 方 穆 组 ， 也 可 以 通过 多 级 、 多 次 喊 差 GM 模型 的 补充 修正 来 解决 。 

(9) GM 模 理 所 得 数据 必须 经 过 逆 生 成 〈 逆 牛 成 是 指 累 减 止 成 ， 累 减 是 指 前 后 棒 个 数 之 
痊 。 记 为 IAGO》 作 还 原 后 才能 用 。 

设 Xi 为 系统 特征 数据 序 殉 ，XOU=23…,N) 为 相关 因素 序列 ，X9P 为 诸 
(=12，… 有 的 LAGO 序列 ， 则 称 

以 站 一 六 时 如 二 及 大 罗 十 和 二 本 各 十 《8.5) 


















为 GM(O,N) 模 型 。 
GM(O.N) 模型 不 含 导数 ， 因 此 为 静态 模型 ， 它 天 如 多 元 线性 四 归 模 型 ， 但 与 一 般 的 多 元 
线性 Il 归 模 型 有 着 本 质 的 |x 别 ， 一 般 的 多 元 线性 回归 建 模 以 原始 数据 序列 为 基础 ，GM(O.N) 


的 建 模 基 而 则 是 诛 始 数据 的 1_AGO 序列 ， 


8.2 干扰 信号 的 灰色 估计 
8.2.1 灰色 估计 的 理论 基础 





灰色 系统 理论 趾 处 理 不 锁定 量 的 -种 有 效 途 系 。 它 需要 信息 少 ， 通 用 性 好 ， 计 算 方 便 。 
采用 大 全 系 统 的 方法 ， 对 于 不 确定 部 分 建立 区 色 横 型， 从 而 可 以 估计 出 不 确定 参数 。 
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设 系统 不 确定 部 分 符合 匹配 条 件 ， 即 为 5D(eD， 其 中 站 (xD 包括 了 天 部 分 : 一 部 分 与 状态 
关 成 比例 ，， 部 分 与 状态 无 关 ， 有 具体 可 描述 为 : 


忆 (z 有 =V 和 二 i++ 二 Var TD=Yx+FD 《8.6) 

式 中 
史 =(W 帮 VY) 《8.7) 
= 人 (8.8) 


设 YG=12.…, 可 及 大 D 均 为 慢 时 间 灾 旦 , 可 视 贡 及 六 有 为 稍 数 。 显然, 如 果 能 辨识 出 双 
及 子 f)， 则 可 得 出 D(zn 与 的 so 的 关系 , 从 而 佑 计 出 对 应 各 状态 关 的 不 确定 量 D(xDD 。 
灰色 系统 的 研究 方法 之 一 就 是 将 原始 数据 进行 处 理 ， 称 为 数 的 “生成 ” 由 于 累加 生成 能 弱化 
随机 性 ， 增 强 规律 性 ， 因 而 它 在 灰色 系统 建 模 中 ， 只 有 有 特 钦 的 地 位 。 

令 zx 为 原始 的 网 散 时 间 哆 数 : 

















0 = Cox xD) 《8.9) 
若 
本 
xDO2 yxrotm (8.10) 
ea] 


则 称 xm(b) 为 ze (ke) 的 累加 生成 ， 记 为 : 
AGOxrO = xx 《8.11) 
按 灰 色 系 统 划 论 ， 采 用 累加 生成 方法 ， 可 建立 类 似 于 GM(0, N) 模型 的 D(xzz) 灰色 模型 。 
令 离散 时 间 函 数 为， 
D =(D DO)…DON)) (8-12) 
7 =CfOU 7 …FNJ) (8.13)》 
= 罗 (2)…20(CVD 
好 一 Cd 信人 (8.14) 
= 态 人 … 芒 (MD) 
式 中 4，N sn+l。 
设 D0，F9，x0G=12 下 为 Dm，A@ xDG=12…, 有 的 昧 加 生成 数列 。 
将 下 述 关 系 : 
万 由 (站 = 克 上 ax 二 十 帮 7 二 丰 《8.15) 
称 为 不 确定 部 分 D(x,D 的 灰色 模型 。 
对 于 慢 时 变 下 扰 部 分 ， 可 认为 : 
aa 
JotD= FOD= 


a 
7000)=2A0)=27 (8.16) 


FOUND = (NA 
记 参 数列 为 : 


.到 力 7 (8.17) 
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记 数 据 矩 隆 为 : 


2 2 1 
| 
(CA CN N-l 


采 肯 最小- 乘法， 芒 (BTB) 林道 ， 则 有 ; 
YT=(BTBJ1 BID 
其 中 ， 
PR =(DOODDOC) DONJT 
将 累加 人 偿 诛 ， 可 得 式 8.6) 的 估计 模型 : 
方才 (上 十 切 ()+ 交 


考虑 由 卜 列 六 个 非 线性 不 铺 定 子 系 统 组 成 的 复合 十 线性 不 确定 系统 ; 


是 二 帮 K(I) 十 下 2 十 奋 D 人 (1 
式 中 ，xe RaeE 避 ,是 为 有 xp 级 禾 阵 ， 记 为 维 征 阵 ，DCeDE 屎 . 


5D(e 虽 代表 系统 满足 此 配 条 件 的 不 傅 定 部 分 ， 它 包括 参数 不 确定 与 外 于 


DrnD=Van+TWe TH + FOOD 
不 伍 定 部 分 的 Do 无 法 折 接 测量 ， 可 由 测量 数据 间 直 计算 佑 机 
离散 化 为 ; 
DoD-_ GD-Ax(D-Pl) 
式 山 ，= 各 ，7 为 采样 周期 。 
灰色 估计 器 的 具体 算法 如 下 : 
第 -- 步 : 建立 后 mb) 诛 始 离散 数列 : 


一.2… 天 
开 二 ].2 
空 于 
第 二 步 : 计算 好 "(6) 累加 离散 数列 
二 2 
开 三 上 2 
第 = 步 ， 计算 
[DO 1 
站 2 
XDAN) (AD AN-1 


式 中 ， 吾 ' 玉 必须 可 道 ， 若 不 可 道 ， 则 应 适当 增加 N ， 直 到 瑟 卫 林道。 


第 四 步 ， 根 据 状态 xf (6 及 式 〈8.25)， 计 算 DPI ( 提 离 散 数列 ， 其 中 


大 [2 
第 五 步 : 计算 9 Gy) 卡 加 山 散 数列 : 
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《8.18) 


(8.19) 


《8.20) 


(8.21) 


《8.22) 


《8.23) 


(8-247) 


《8.257 


《8.267 


《8-.27) 


《8.28) 


万 由 一 (DID 万) Do) (8.29) 
第 六 步 ， 计 筑 不 确定 参数 估计 值 : 





攻 = (用 TB 机 TDU 《8.30) 
乡 -= 次 六 六 (8.31) 
8.2.2 仿真 实例 
仿 趴 对 象 为 : 
CO 一 二 


将 该 传递 函数 转化 为 状态 方程 的 形式 ; 
大 二 山 X 十 盏 红 十 帮 有 (Er 


0 1 _ [0 
xl an -二 全 


由 士 对象 为 . 阶 传递 函数 ， 达 代 次 数 可 选 WY 2， 取 W =3。 
笨 入 信号 取 正 弦 信 号 &=050sint) ， 外 加 十 扰 取 (xDD = TEA 。 
取 如 下 4 组 干扰 参数 : 
Wi = [0.10.0.10.0.101 
帮 =10.30.0.30.0.501 
全 = [0.50.0.50,1.501 
乃 =[1.50.1.50.5.0] 
经 过 三 个 采样 时 间 ， 分 乔 得 到 下 扰 参数 估计 结 炒 ; 
到 =[0.1021 0.0997 0.0998] 
广 = [0.2987 ”0.2990 ”0.4955] 
伪 =10.4919 0.4933 ”1.46861] 
六 =[1.3873 1.3912 ”4.5875] 
由 此 可 和 见 ， 采 用 灰色 佑 计 的 方法 可 有 有 效 地 个 计 出 干扰 参数 。 
仿真 穆 弛 的 主 程序 ，chap8g_lm， 


SGrey maael preqicticr， 





clear al1iClose 二 L17 


日 Pal u 口 


Paraa-[] 7 


RPR=zerogs (2 3) 7 







212 ia X Gerension number) 
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%Using Srey mcael to breaict disturbance 
V=zeros11,317 

Bara=Ll1: 

[t,Xx]=ode451 "chapa_lecG' TimeSct, [0 0],[] ,Para,V): 


x22=x(:2)) ssSpeed va-ve 





za zhPe fizst value (not inclucing 七 ia value) 





D=yerostN-1,1) 1 
for Kk=23:1:MN+1 
daxtk)=(x22(k)-x22(Kk-J))7LS7 
ulk)=0.50*sin (kxt3)7 
DIx)j=17bprtddx (k)+Jxx220k)1-u(k)7 


enQ@Q 





P1=zeros ty，1) 1 
DT111) -2f15+D(2) 7 
for k=2:1:H 
PICk)=DL(k-1)+D4K+I1) 7 


enmng 


V=invIBB' xBB)xBRB*D117 


V=V， 





M 函数 程序 ，chap8_leq.m。 
function dx=pynamicModel(c,x,f]ag,ParayVh 
glebal 了 b 


日 X=ZerCSTZ 


=25;b=1331 








elseiEt N=-2 


[03003175f=8 .57 





elseif 


VT1.5 1.5]7T-37 


EnG 
ED=Y (1 XI(21 人 (2 有 3yLen” LIUe qi SUTDSnCEe 
U-D-5ox*sinit)7 SGJwe  S2TIe 呈 8na | 和 DC 


QxXILT=XT2 


ax(2)--J*xt21brfu<pnii 
8.3 灰色 PID 控制 


8.3.1 灰色 PID 控制 的 理论 基础 


灰色 系统 理论 是 处 埋 不 确定 芋 的 一 种 有 效 途 径 。 它 需要 信息 少 ， 通 用 性 好 ， 计 贷方 使。 
采用 灰色 系统 的 方法 ， 对 二 不 确定 部 分 建立 火 色 模型 ， 利 用 它 来 使 控制 系统 中 的 艾 量 得 到 
定 程 度 的 白化 ， 以 提 训 控 制 质 些 及 共 曾 棒 性 ， 

设 系统 不 确定 部 分 符 台 匹 机 条 付 ， 即 为 De 六， 共 中 PCD 包括 两 部 分 : 一 部 分 与 状态 
成 此 例 ，- 部 分 号 状态 左 关 ， 有 具体 可 描述 为 : 


站 (站 = 员 本 十 辐 让 二 二 WOD=T 交 + (8.32) 

具 中 ， 
和 = 全 到 VD) (8.33) 
了 TO (8.34) 


设 站 G= 812 站 及 Fe) 均 为 惕 时 间 变 量 , 可 视 W 及 .G) 为 常数 . 显然 ， 如 果 能 辨识 出 丈 
及 庆 六 ， 则 可 得 出 Dep 与 畔 三 和 sm 的 关系 ， 从 而 可 估计 出 对 应 各 状态 工 的 不 确定 量 
D(x 昌 ， 友 色 系统 的 研究 方法 之 一 就 是 将 原始 数据 进行 处 理 ， 称 为 数 的 “生成 "， 由 丁 黑 加 
和 牛 成 能 弱化 随机 人 性， 增强 需 律 性 ， 风 而 它 在 灵 色 系统 建 模 中 ， 具 右 特 殊 的 地 位 

令 x 为 原始 的 离散 时 间 琢 数 





WO (CD (2 oOD) (8.35) 
苦 
上 
xz0(0= > xm (8.36) 
筷 


则 称 zf 有 为 xi0(E) 的 时 加 牛 成 ， 记 为 : 
AGO = 《8.37) 
按 欧 色 系 统 理论 ， 采 用 累加 生成 方法 ， 可 建立 类 似 士 GM(0.N) 模型 的 PCxnD 灰色 模型 ， 
令 离 散 时 间 国 数 为 
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DO =(D(D DO)…PCON) 
7 = A2)…7CNJ) 

= 0000 克 (23 CN 
= (20(ND 


(为 (人 … 加 (CN 
式 中 ，N EL+1 。 


《8.407 


设 D0O 8 MGCs=12 站 为 Do，70，30G=12…, 且 的 累加 生成 数列 。 


(00D=J 太 十 作 x 和 二 二 + 
称 为 不 确定 部 分 D(x.D 的 灰色 模型， 
对 士 慢 时 变 十 扰 部 分 ， 可 认为 
、 
FOOD= AD=A 


AD)= 270227 


CO = 


记 参 数列 为 : 
六 了 从 交 玫 方 T 
记 数 据 和 矩阵 为 ; 
2 0 
哩 -| 9) 2 
昌 MAD CN N-1 


采用 最 小 二 乘法 ， 若 (BTIB) 可 道 ， 则 有 : 
区 T= (8TB)-1BTD 旬 
其 中 ， 
DO =(DO(DDO02)DOUNJ)T 


将 累加 值 还 点 ， 林 得 式 〈8.6) 的 估计 模型 ; 
访 0D = 六 大介 + 区 (++ 交 c( 二 六 


8.3.2 连续 系统 灰色 PID 控制 


考虑 由 卜 列 双 个 非 线性 不 确定 子 系统 组 成 的 复合 非 线性 不 往 定 系统 ; 
部 = 4x(D)+Ea(tD)+BD(x.1 


式 中 ，xze RE 民 ， 生 为 x 天 维 矩阵 ,五 为 上 绯 矩 阵 ，DGxtE 玉 。 


6D(cgt) 代表 系统 满足 匹配 条 件 的 不 确定 部 分 ， 它 包括 参数 不 确定 与 外 于 
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《8.417) 


《8.42) 


《8.43) 


《8.44) 


《8.45) 


《8.46》 


《8.47) 


《8.48 7) 


厂 ( 革 上 = 凡生 十 和 十 十 十 大 (有 
采 几 PID 控制 ， 
DO =e(GDT 大 袜 ce(DT Tide(b 
到 =] 


《8.49) 


《8.50) 


为 了 碱 弱 不 确定 部 分 的 影响 ， 改 善 控制 性 能 并 提高 鲁 棒 性 ， 在 控制 器 启动 过 程 中 ， 首 先 
采用 灰色 估计 器 将 不 确定 部 分 模型 参数 Y 粗略 地 估计 出 来 ， 然 后 对 P(zx 蚊 加 以 一 定 程度 的 补 





偿 。 由 于 这 种 砚 色 估计 不 要 求 连续 实时 地 进行 ， 故 不 存在 通常 实时 辨识 中 存在 的 数据 发 散 问 


题 . 





不 确定 部 分 的 Do) 无 法 直接 测量 ， 可 由 测量 数据 问 接 计算 估 册 。 
离散 化 为 ; 
DrK) = 了 GO 一 4x( 们 一 Be 人 D) 
式 中 ，t= 杂 ，7 为 采样 周期 。 
灰色 估计 器 的 具体 算法 如 下 。 
第 一 步 ， 建立 xm 人) 原始 离散 数列 。 


一 1.2，……, 玫 
大 =12…,N 
人 
第 - 步 : 计算 如 (6 宗 加 离散 数列 。 
一 2 
K=12 
第 三 步 : 计算 
2 (2) 1 
-| 2 
xDCON) OOCNW) 六 一 上 


式 中 ，BTIB 必须 讨 道 ， 若 不 可 首 ， 则 应 适当 增加 W ， 直 到 巨 5 可 逆 。 
第 四 步 : 根据 状态 xz 人 6) 及 式 (8.51)， 计 算 DO 离散 数列 ， 其 中 
大 =12N 
第 五 步 : 计算 DO (6) 昌 加 离散 数列 : 
DB = (Do DO(0) 交 DON) 
第 六 步 ， 计算 不 确定 参数 估计 值 : 
六 =(BTBLBTDD 
攻 = 丰 态 …… 记 户 半 
具有 灰色 估计 器 的 PID 控制 方法 分 为 以 下 两 个 阶段 。 
第 - .阶段 ， 采用 PID 进行 控制 ， 对 不 确定 部 分 的 模型 参数 Y 进行 估计 。 


第 二 阶段 :经 过 丈 步 后 ， 在 上 述 控制 律 基础 上 ， 按 估计 参数 交加 于 补偿 控制 w 


了 十 


ce 


《8.S17 


《8.352) 


《8.537) 


《8.54) 


(8.55) 


《8.56)》 


《8.577 
《8.58) 


此 时 
(8.59) 
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-| 呈 | (8.60) 


加 且 和 和 人 
PPcD=>(7-YD5+CFGD 一 廊 (8.61) 
1 


采用 控制 律 式 〈8.59)， 系 统 性 能 将 大 为 改善 ， 重 棒 性 大 为 提高 。 
8.3.3 ”仿真 程序 及 分 析 


仿真 实例 

设 被 拧 制 对 象 为 ; 

133 
ss+25) 





GD 


将 该 传递 函数 转化 为 状态 方程 的 形式 : 
天 一 克 三 十 盏 红 十 五 DD(X 人 1 


式 





T 
卫 
于 一- 
忆 所 
1 
人 
包 
之 ， 
习 
1 
扩 己 
民 
虑 
忆 


外 加 于 扰 为 : 
PCDD= 交 RD 二 TDTz 十 太 
取 干 扰 参数 了 = [5.0.5.0.5.0]， 采 用 连续 系统 灰色 PID 预测 ， 经 过 三 个 采样 时 间 ， 得 到 于 
扰 参数 估计 结果 : 





六 = (4.64215,5.0129.5.05971 
取 M =1， 不 采用 灰色 预 佑 补偿 ，PID 控制 跟踪 误差 及 变化 率 如 图 8-1 和 图 8-2 所 示 ， 取 
4 =2， 采 用 灰色 预 估 补 偿 ，PID 跟踪 误差 及 变化 率 如 图 8-3 和 图 8-4 所 示 。 


0.6 - 一 

















0.5 


04| 
oa3| 


emor 


02 





-0 -一 _ 一 
0 0.5 1 1.5 2 
timets) 


图 8-1 PID 跟踪 误 养 〈MH=]1) 
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derror 





-20， -一 一 | 
0 


05 timbs) 


图 8-2 PID 跟踪 误 差 变化 率 
0.6 一 - 一 


eror 





-0.1 一 一 一 ， -一 - -- 
DO 1 

timets) 

图 8-3 灰色 PID 中 踪 误差 〈MH=2) 


1 一 一 -一 一 _ 








05、 1 
timets)》 

图 8-4 灰色 PID 跟踪 误 养 变化 率 
主 程 序 ，chap8_2.m。 


S$PID Control basaed on Grey model compensat1on 
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clear al1;close al1: 
Global a21 a22 b 和 B KpP ka 


Para=[]， 
BPB=zerosf1 3》 


ts=0.0017 
&Needing N>=212 is x Qemensicon Dumber) 
TimeSet=[0:ts:eswN]7 





&Using grey model to predaict dieturbance 


V=Zero8(t1, 3) 


[t,x]=odqe45{ chap8_2f' TimeSet, [0.5 0.5]，[] ,ParaV) 7 
X1L1=X(3，1)7 
X22=X(: 32) 
xl1=x(2,，:);) SIt is the first valuelnot including initial value) 


BB=[xttl 3:)，1]7 

for k=2:I: 本 
x1=fx1;x] (k-1,:)+xtk+l，3)]7 
BB=[TBB; FExl (kK,:) k]] 7 


end 


D=zercst(N+1,1) 
For k=231:N+1 
ddx(k)= (x22(K)-x22(k-1)) /ts 
Up (K)=Dbxkp*x11{K) +bxkGxx221K) 7 
Dtk)=1/by (ddx(k)-a21xxll(k)-a22*x22(k)-uPtk)) 1 
end 





D1=zeros(Nv, 1) 7 

Ditl)=D(I)+D(2) 7 

for k=2:1:H 
D1(k)=D1(K-1)+DIKk+I1) 


en 


V1=inv(BB'*BB)*BB'“D17 
VY=V1， 


S$Grey PID control using grey prediction result 
N1L=20007 

Timeset1l=10:ts:tsxNT]7 

[t,xl=oae45{'chap8_2f' ,TimeSet1,[0.50 0.50],[],para,V]i 








for K-1:1:N14+1 
kea= [ke xdl， 

up(kj=kpar[xlfk);x2{k)]， 
uctk)j=-Vr [xltk) yx2(k);1]; SGrey compensation 
uk)=up(k)ructk)， 

end 

figuret1)7 

plor (Ex 

xlabelf'timels)')7zylabelt'error')i 

figure(2)7 

plot te,x2)7y71abelt'derror') 

xlabel('time(s)')7ylabelt'aerror' 1 

figure(3)7 

plobttyu); 

xlabel('timets)'17ylabelt'u' ji 


对 两 数 程序 ，chap8_2fm。 

8Dynamic model 

function ax=DpynamicModel(t,x,tlag,paraV) 
global aal a22 b a B kp ka 


Qx=zeros {2，1) 了 


Ba21=07a22=-257 
D=1337 


B=[fO;b]: 
Rs=Ig 1;a21 己 22] 1 


V1=15 35] 
二 =5 > 


DDP=V1*x+E; &SyStLem true qisturbance 
Concrol 1aw 

kKP=-351 

kd=-57 

UP=jKP*x(11+KGAX12) 





gsNO Grey Compensaticon 


elsejif M==2 


Uc=-V*[x;11; SGrey Compensation 
enq 
=up+ruci 
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GX= 吾 +X+BA TU+DD) 7 
8.3.4 离散 系统 灰色 PID 控制 


直接 针对 离散 系统 模型 的 PID 控制 基 有 很 多 对 实际 应 用 有 价值 的 优点 ， 但 由 寺 不 俩 定 部 
分 对 控制 的 影响 不 能 忽略 ， 使 控制 器 难 丁 适应 各 种 不 确定 性 。 为 下 ， 提 出 对 不 确定 部 分 建立 
灰色 估计 模型 ， 丰 有限 步 数 后 ， 根 据 参数 对 不 确定 部 分 进行 - 定 的 补偿 ， 以 减 小 其 影响 。 
考虑 单 输入 离散 系统 : 
(类 十 站 = 4x( 引 十 瑟 E( 大 ) 十 五 有 (天 )》 《8.62)》 
其 中 ， 
XE 玉 3EE 及 D(xKE 妨 
式 中 ， 由 为 mx 了 系数 中 阵 ， 有 为 维 矩 阵 ，5D(xc 昌 代表 系统 满足 严 配 条 件 的 不 确定 部 分 。 
它 包括 参数 不 确定 与 外 干扰 等。 





历 ( 守 丰 ) 一 砚 辐 十 凡 和 十 二 及 十 红 ) (8.63) 
控制 律 分 为 两 个 阶段 。 
《1) 采用 PID 控制 进行 灰色 预测 。 
2( 扣 二 Do () 《8.647? 
Do- 二 Gaox 一 aa-bun() (8.65) 
可 计算 离散 数列 向 量 : 
Do2(p(0) DO DN-Dr (8.66) 
上 
DO(O=y DO (8.67) 
气 
DO20pod) Do DON-D) (8.68) 
由 此 了 可见， 在 六 步 后 ， 即 可 估计 出 灰色 模型 的 参数 向 址 疼 T 
DG 有 =VxD(GDTP(DT Te (D+dOCO (8.69) 
乡 = 人 只 记 六 访 (870) 
式 中 
do(O= ya0 《8.71) 


上 0 
di 有 为 慢 时 变 扰动 ， 在 控制 过 程 中 可 看 做 不 变 的 常量 ， 将 gf) 记 做 了 
按 最 小 一 乘法 公式 ， 可 求 得 : 


六 IT=(BTB)1BTDO (8.72) 
其 中 ， 
0 1 
间 G 人 “ (873) 
xDON) CN) N 一 1 
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上 有 : 


式 中 


控制 


jaets"si>e>0 (8.74) 
(2) 采用 灰色 PID 控制 
在 (e+DT 步 后 ， 增 加 补偿 控制 & ， 此 时 ， 





玉 三 p 十 Me (8.757) 
辐 - 过 -| (8.76) 

在 第 - 阶段， 估计 器 停止 上 作 。 

8.3.5 仿真 程序 及 分 析 

仿真 实例 

被 控 对 象 为 : 


以 梁 样 时 间 为 lms ， 将 传递 函数 转化 为 离 若 状态 方程 的 形式 : 
XRD) = 4x( 十 MK( 人 十 及 DC, 丰 ) 
[Lo 00010| -|[-00001 
”” [oo 09753|” 1-0.1314 


外 加 干扰 参数 Y =[0.50,0.50.0.50] , 采用 离散 系统 灰色 PID 预测 , 经 过 5 个 采样 时 间 的 PID 


， 得 到 干扰 个 计 结 果 为 : 六 =[0.50000026835824.0.50000000007557.0.49999987408683]。 
取 aMf =1， 不 采用 灰色 预 估 补 偿 ， 而 只 采用 PID 控制 ， 跟 踪 误 差 及 变化 率 如 图 8-5 和 























图 8-6 所 示 。 取 M =2, 采 用 灰色 预 估 补 偿 , 跟踪 误差、 误差 变化 率 及 控制 器 输出 如 图 8-7 一 
图 8-9 所 示 。 








error 





0 0.5 


1 1.5 2 
timets) 


图 8-5 PID 跟踪 误差 CHM=1) 


"363。 





deror 








15 2 


0 05 二 
timets) 
图 8-6 PID 跟踪 典 差 变化 率 
0.03 - - - 
0.02 
丰 001 
和 
0 
-0.01- 本 
0 0.5 1.5 2 


derror 


二 
timets) 
图 8-7 灰色 PIDD 跟 味 误 美 (M=2) 











-0.5 1 


D 0.5 1.5 2 


timbts) 


图 8-8 上 忒 色 PID 女 踪 误差 变化 率 





-03， 一 一 -一 一 一 - 





0 0.5 


1 
timets) 
图 8-9 灰色 PID 控制 器 输出 
仿真 程序 :chap8_3.m。 


sDiscreted PED with grey model Drediction 
Clear all7 
close al11 
S= 昌 .0017 


mn=27 


=n+37 


Ba=257Db=]1337 

J=171331 

qz=25/7133) 

SYS=tf(1， [JS 0]1 7 
dsys=c2dtsys,ts， zi 


[num,Qen]=tfdataltdsyvs，v' 1) 7 


&L=E0,1:0, -al 

bl=107Pb] 7 

Cl=[1,0] 7 

DPI=07 
[Rb,C,D]-c2dgm(R1.bl,cl,Dl,te， gz) 





%Umeertaln FarameterSs 


"365， 





V=l0.5 0.5]7Q=0.57 
和 ID alL Value 
x-L=T1171]7 


8Grey prediction 
for X=i:13: 
上 ime (kk)=Kxtey 
xl1(k)=x_141) 1 
x20c)=x_112)1 





DIki=Vxx_1+dry 


Jp=2.0; 
ERP (kj=kKp*x1 (kJ 7 
utki=up(k) 了 


D=V*Xx_1+Q7 
= 六 *X_1+Dyu(k) 十 D*D 六 
X_1=X7 
eng 
xacl(1)=xlt2) 7 
XX211] =x2(2) 1 
BB= [xx111) xx2(1) 1]7 


for ii=2:1:N-2 
xx1l(ij=xxl(ti-1)+xL1UL+IL) 
xx3 (TI)=xx2 人 -1L)+X21i+I) 7 
BB=[BBFXX]{i) xx2(i) 了 


CDnQ 


for 工 =1: 工 :区 -1 
Ptiy=1xbxttxlti+1L)7x2{i+1l)]-aAx[xttI)7x2ri)]-brupti)) 7 
emnQ 
P1Lt])=DI2)7 
for 1=2:13:N-2 
D1tiy=D1(i-L)+DIT+1L) 7 
enq 


sabs (det {BB'*BB) ) 
Vli=invIBB'ARB)*BB'xD1' 7) 
VBp=v1 


&Grey PID control 
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其 


X_I-=xX_07 
ML1=2000， 
for k=]3:13:N1 
二 me fk) =KxtS7 
XI (ki=x_1Lt1)7 
x21Ki=X 112)7 


DPIfK) =VyYX_ 1+ 吕 ; 


gsControl law 

M=13 

if M==1 &NO Grey Compensatjon 
uctkl=97 

elseif M- -2 gsGrey Compensaticn 
uctk=-(vYpll)*x_ 1tL)+Vp(2)*x_112)+VPI3) 1 

end 

uptK)=kp*xl (和 ) ; 

utk3=uptk)+uctkj7 


D=V*x_1+ey 


芭 = 遇 *X_ 二 PUTK) + 中 7 





Xi 


ed 


figure 1) 

plot (ttime,xl) 7 
YXlabelt'time(s)')7Ylapbel( error ) 7 
figurel2) 17 

Blet (Lime,x2) 

Xlabelf'time(s)') ;yzabelt'derror' 7 
figurel311 

Plor ttime,u); 

xlalbpel( time(s) ) 7YIabelf ui 


8.4 灰色 PID 的 位 置 跟踪 


8.4.1 连续 系统 灰色 PID 位 置 跟踪 


考虑 单 输入 连续 系统 : 
产 = 4 站 十 百人 十 坟 D( 攻 





XE 玉 HE 办 ，PD(rnDE 尺 


《8.77) 
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式 中 ，4 为 nx 天 维 矩阵 ,5 为 对 维 矩 阵 ，B#D(x 昌 代表 系统 满足 匹配 条 件 的 不 确定 部 分 ， 它 包 
括 参 数 不 确 定 与 外 干扰 等 。 








历 (X 有 = 切 太 十 几 轴 十 十 十 天 (用 〈8.78)》 
取 输 入 信号 为 : 
r(D= 0.5sin(2rF0) 《8.79) 
离散 化 : 
元 卫 =0.5sin(27FKT) (8.80) 
式 中 ， 忆 为 输入 信号 频率 ，7 为 采样 时 间 。 
令 
玉 "(D=[r(D) 交 D (8.81) 
控制 律 分 为 以 下 两 个 阶段 。 
(1)》 采用 PID 控制 进行 灰色 预测 
xu 人 0= 如 全 《8.82) 
DCo 昌 -了 G+ 人 -2 (8.83) 
计算 离散 数列 向 量 
万 岂 2(D0O DO) … DONDT (8.84) 
Do(D2 训 DUO) (8.85) 
0 
DO 2po0O) Do) 本 DOCUV) (8.86) 
在 N 步 后 ， 即 可 估计 出 灰色 模型 的 参数 向 量 乡 T。 
PCD=VaxD+ 多 (De 二 区 xD+Fe 人 GD (8.87) 
背 = 人 人 记 …… 六 7 《8.88) 
其 中 ， 
让 
JoD= > GO (8.89) 
4 


CD 为 慢 时 变 挑 动 ， 在 控制 过 程 中 可 看 做 不 变 的 常量 ， 将 7(D 记 做 了 了。 
按 最 小 二 乘法 公式 ， 求 得 : 


背 T= (BTB)-LBTDO (8.90) 
其 中 ， 
xz) (2) 1 
AD 站 0 
理 -| 守 轩 二 四 《8.91) 
xD xm N-1 
且 有 : 
|aetarBj>e>0 (8.92) 
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〈2) 采用 灰色 PID 控制 。 
加 入 补偿 控制 we ， 此 时 ， 


下 各 十 引 (8.93) 
必 二 -| 好] (8.94) 
各 
在 第 二 阶段 ， 估 计 器 停止 工作 。 
控制 系统 状态 方程 为 : 
郊 = 4 十 Be 十 下 D 人 (人 (8.95) 
感人 (和 有 = 太 嫩 十 友 贡 十 地 (8.96) 
采用 带 有 灰色 估计 器 的 补偿 PID 控制 : 
人 HH。 (8.97) 
不 加 灰色 估计 器 ， 只 用 PID 控制 ; 
下 一 (8.98) 


8.4.2 ”仿真 程序 及 分 析 


仿真 实例 
考虑 单 输入 单 输出 连续 系统 
广 = 4x(D Ba 人 (DB5D(zD 
To 1 T 
式 中 ， 4 -二 了 =(0 133) 


外 加 干扰 参数 为 V=[5-53 ，d=5， 经 过 4 个 采样 时 间 ， 干 扰 参数 估计 结果 为 
VY =[4.7117,.5.0109,5.2018] 。 

指令 信号 为 一 个 幅 值 为 0.50， 频 率 为 1.0 的 正弦 信号 。 取 M =1， 不 采用 灰色 预 估 补 偿 ， 
即 xe(=0， 位 置 眼 踪 如 图 8-10 所 示 。 取 M =2， 采 用 灰色 预 估 补 偿 ， 位 置 跟踪 如 图 8-11 


所 示 。 


























-1 - - 一 
0. 1 
0 5 timel(s) 


图 8-10 PID 位 置 跟踪 “CHM=1) 
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tmdes) 


图 8-11 灰色 PID 位 置 跟 踪 《〈《M=2) 
主 程序 :chap8_4.m。 
8Grey model BID Control 
Cjlear allrcelose all7 
对 Lobal kp kd 己 阳 六 悍 已 Ra 


F=1.01; 
Para= []: 
RD.507 


&%Disturbance PredQiction 
BB=Zeros1t1,，3) 7 
ts=<0-001; 
=47 
ab=abs [det [BB'*BB)) 

TimeSet=[0:+Ss:ts*N] 1 

V=zeroSt1, 3 

[FE,yj=ode45[' chap8_4f' ,TimeSety, [0 0], [ParavV) 


wwpiwF; 
工 = 瑟 疝 * 【名 说 人 WA 七) ) 了 


Qr=RARAxwsCOSfWA 七 ] 7 


Y0=Y7 
Y1=y0(2，:)7 
BB=[y1(1,:) 1]17 


Eor k=2:1: 
Y1=[Y1;Yy1{k-1y +yYO(k+l 2)]7 
BRB=[BB7 [yl1fxz,:》K]]7 





SGrey Prediction 


(117 
Y22=Y(:v2) 17 





D=zeros (N+1，1) 7 
for Kk=2:1:N+1 
DI(ky=17p*f(y22{K)-Y22(K-1)) 7LS-a*y221K)-Pykps (riIk-yY1LL(kK))- 
Pr*kq* faritk)-y22(k) )) 7 
enQ 


D1=zeros (NI) 1 
D141)=D{2] 7 


for k=2:1:M 

D1 (xy=D1(K-1L)+DIk+rl) 
end 
ab=abs (det(BB'*BB) ) 


V1=invfBB'*BB)*BB'xD1; 
V=V1， 


PID Control 

N1-20001 

TimeSeLl=[0:ts:cssN1]3 

ft,y]=ede45('chap8_4f， :Timesetl, [0 0] ,[] ,parayVji 


YL1=Y(3v1)1 
y2=Y(: 2]1 
=RAPnw (sirmtwxt)) 7 
ar=aRxwwCOS (WAt) 


Qar=-RRx*Ww“2xSir(wst) 7 


er-Yyl17 

de=dr-y2; 

for k=1:1:NL+1 
up(k)=kpxe(k)+kdrde(k)， 
ucUD=-vs [yl(kjyy2(k)i1]; SGrey Compensacion 
ak)=up(k)+uctk) 1 

ena 

figuretl) ;grid onz 

pleEttr zceEiy(sy1) Pb 

xlabel('timels)' 13ylabeltzr y')7 


figurel21;gria on 
Blot tc TY 7 
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X1apelt'time(s)' ) zyY1Label(' error') 


figuret3) ;gria ony 
BDILOL (tu) 
XlLabelt'timetSs)')7Yylabel(a'): 


Mf 函数 程序 ，chap8_4fm。 

sDynamic model 

function dy=DynamicModel tt,y,flag,parayV) 
glLebal kp kq 冯 划 站 日 卫 A 

ay-zeros(2,1)7 


TDPUL SiSnal 

W=2YERIKE 7 
IF=RRAYSiITWA 七 ) 
ar=RRAx*wrCOS (Www 七 ) 7 
Gar=-aarfw^2)wSiniwx 七 ) 7 


T=[rryrar] 7 


JP=133;a=-257 
B=[07P]7 
&=[0 170 aa]; 


V1=[5 5];f=5; 


DD=V1wy+Ei mrue disturbance 
%Conptrol am 
kp=301kd=5.0;kpa=[kp,kd]y 
up=kpax (T-y) 7 


#NO GreyY Ceompensation 





elseif 到 ==2 


uc=-v* [yi11; SGrey compcnsation 
eng 
u=up+uci 


Qy=Ra*y+B* (ur+DD) 
8.4.3 离散 系统 灰色 PID 位 置 跟踪 


考虑 单 输入 离散 系统 : 
(天 十 上 一 帮 x( 天 ) 十 入 ee( 天 ) 十 百 PD(z 天 ) 


.372。 


(8.99) 


成 中 ，xE RuERDUKJERR，4 为 nx 维 拓 阵 ，B 为 二 绒 敌阵 。 





5P(xz. 杂 代表 系统 满足 匹配 条 件 的 不 筑 定 部 分 ， 它 包括 参数 不 确定 与 外 于 
DC 有 = 机 硬 二 Wi 二 十 包 十 GE) 
取 给 入 全 号 为 ; 
r(D=0.5sin(2rF0) 
离散 化 为 ; 


r(k) = 0.5sin(27FKT ) 
式 中 ，F 为 输入 信号 频率 ， 了 为 采样 时 间 。 
令 
至 !(E)=Tr(E) 站 )] 
控制 律 分 为 以 上 两 个 阶段 。 
《1) 采用 PID 控制 进行 灰 亿 预测 。 
扩大) 一 p( 克 ) 
D(x 拉 =Db(Ox( 开 +D 一 Ar 一 再 x( 天 ) 


可 计算 岗 散 数列 向 量 : 
Do2s(p(0) DOD pw -Dr 
Dm(D2 训 DUO 
0 
Da2rDotr0) DOD DOON 一 TD 


由 此 可 见 ， 经 过 六 步 后 ， 妇 可 估计 出 灰色 异型 
丰 ( 间 二 区 DR 二 区 DO+ 二 VODJ+dmCRD) 


的 参数 闪 量 区": 


其 中， 
下 
<a0(D= >dO 
上 0 
Li 为 慢 时 变 扰 动 ， 可 看 做 不 灾 的 常 基 ， 将 dt 记 做 芝 。 
按 最 小 乘法 公式 求 短 : 
疡 7T-(BrB)-LBTDO 


其 中 ， 
于 1 
玉 - xD 0(3) 2 
xDNJ CVD N -1 
卫 有 


|aeksraij>se>0 


F 扰 等 。 


(8.100) 


(8.101) 


《8.102) 


《8.103? 


(8.104) 
《8.105) 


(8.106) 


《8.107) 


《8.108) 


《8.109) 


《8.110) 


《8.1117) 


《8.112》 


(8.113) 
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《2)》 采用 灰色 PID 控制 。 
增加 补偿 控制 w， 此 时 控制 律 为 : 
下 一 吕 十 开 《8.114) 


， 
克 -| 闻 s4| 《8.115) 


在 第 二 阶段 ， 估 计 器 停止 工作 。 
8.4.4 仿真 程序 及 分 析 


仿真 实例 
考虑 单 输入 连续 系统 : 
元 = 并 十 5 十 五 DO 人 


4-|? 1 ,5I=(0 133) 
0 -25 


以 采样 时 间 lms 离散 化 为 : 
ED= 4r(ED+Ba( 避 +BD( 昌 


| .001 
4 000 中 | 3 =(0.0001 0.1314) 
0 09753 


外 加 干扰 参数 为 =[5.- 引 ，d=5， 经 过 个 采样 时 间 ， 可 得 到 干扰 参数 估计 结果 : 
TV =[5.0000 -5.0000 5.0000] 


指令 信号 为 -个 幅 值 为 0.S0, 频率 为 3.0 的 正弦 信号 . 当 G =1 时 为 PID 灰色 预测 , 当 G=2 
时 为 BID 灰色 控制 。 在 灰色 PID 控制 时 ， 取 H = ! 为 不 采用 灰色 预 估 补偿 ， 即 zs(t)=0， 位 
置 跟踪 如 图 8-12 所 示 ; 到 M = 2 为 采用 灰色 预 估 补偿 ， 位 置 跟踪 如 图 8-13 所 示 。 


051 




















TXT 
局 











0 0.2 0.4 timets) 06 0.8 1 


网 8-12 ”未 采用 灰色 预 估 补偿 PID 位 置 嘴 踪 CM=1) 
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0 0.2 0.4 D6 0.8 1 
timets) 


图 8-13 灰色 PID 位 贺 跟 踪 (MUWH=2) 
仿真 程序 :chap8_5m。 
&Discrete PID Control with grey model preaiction 


Clieatr all; ， 


close al17 


七 S= 各 .001 


m=27 
局 -5S7 
FE=3.07 


N1=10007 


=nD+37 


w=2x*pisF7 


S&SYstem model 


R&Al=[O 170 -25]1 
B1=[97133] 
Cl1=[1 0]; 
D1=[0]7 


[&,B,C,D]=c2dm(al, Bl,C1,D1 ES Z 1 


V=[5 -5];a-5; 
x_l=fi0;0] 7 
for G=1:2 

For K=1:1:B 


ime (K) =KsEs7 
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工 {K) =AAx [Sintw*KxtS) ) 7 


Gy (K) =aAxrwWyCOS TRYKY 亡 提 ] 


xik)=x 1f)7 
X21K)=X_1(2) 7 


scControl law 
if G== 8FOF Grey Preqjiction 


$For Grey PID Control 


SNO GTey Compensation 





elseit M=-2 8%Grey Compensation 
uctkj=-tvp()xx itL)+VPI2)x-1(2)3VP(3)) 7 
eng 


eng 


kp=80;ka=101 
et =rtk) -xl1tk) 
aetk)=qr(k)-x2(k)7 


up{k) =kpxe(k)+kdqxaefk) 
u{K) =uP{Kk)+ac (KJ) 


多 P1 am 
DD=V*x 1T+G7 
区 = 玉 *X_1+BxUI( 攻 +B*PD; 
x_1=xi 


emQ 


二 E G== 第 GFreY PEeGictioan 
xx1(1) =xL(2) ;7XX2(11=x2(2)17 
BB=fxxIT(L) xx2(1) 工 ] 7 


for =2:17:N-2 
XX1 (I) =xxX1(I-1)+X1LI+TLT) 
XX2 ( 诫 ) =XXZ 1I-L) +X2 (iT+IT) 
BB= [BB;xx11{i) xx2(T) 土 ] 


emQq 
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DDDti) =1IZB* 
emnQ 
D1(1)=DDD12) 


=KP*efIiy+kQraetii 7 


Lxlti+l):x2(i+2)]-ar xlti)yx2t) 


D14)=D520-2)+DODII+ll 





ab-abstdact PR' *PRR) ) 


V1- 





Vp=y]， 


end 


N=NL;， 8%If G=2 


en 


2V(BB +B) *BBI<D1 7 


figuxetl)7gria on 


PottLime, rr time ,xl pb) 


xlabel('timets 


》 





YIabell yxXlL 


55guret2)797ria on 


了 Lot (ieE-X1，DP 1 


X1aDbel( imets 
王 





Pet ttime ul 


xlabejl (time(s 


》 











;yl1abel('error' ) 
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第 9 章 伺服 系统 PID 控制 


9.1 基于 Lugre 摩擦 模型 的 PID 控制 


9.1.1 人 饲 服 系统 的 摩擦 现象 





在 高 精度 、 超 低速 伺服 系统 中 ， 由 于 非 线 性 摩擦 环节 的 存在 ， 使 系统 的 动态 及 静态 性 能 受 
到 很 大 程度 的 影响 , 主要 表现 为 低速 时 出 现 叹 行 现象 , 稳 态 时 有 较 大 的 静 差 或 出 现 极限 环 振 水 。 

摩 氛 现 象 是 一 种 复杂 的 、 非 线性 的 、 具 有 不 确定 性 的 自然 现 银 ， 摩擦 学 的 研究 结果 表明 ， 
人 类 目前 对 于 摩擦 的 物理 过 程 的 了 解 还 只 停留 在 定性 认识 阶段 ， 无 法 通过 数学 方法 对 摩擦 过 
程 给 出 精确 描述 。 在 现实 牛 活 中 ， 摩 擦 现象 几乎 无 处 不 在 。 在 有 些 情况 下 ， 关 氛 环节 是 人 们 
所 期 望 的 ， 如 汽车 的 刹车 系统 ， 但 对 于 机 械 伺 服 系统 而 言 ， 摩 擦 环节 却 成 为 提高 系统 性 能 的 
障碍 ， 使 系统 出 现 咎 行 、 振 荡 或 稳 态 误差 。 为 了 减轻 机 械 何 服 系统 中 摩擦 环节 带 来 的 负面 影 
响 ， 人 们 在 大 量 的 实践 中 总 结 出 很 多 有 效 的 方法 ， 可 概 撕 为 三 类 : 

《]) 改变 机 械 伺服 系统 的 结构 设计 ， 减 少 传动 环节 ; 

(2) 选择 更 好 的 润 消 剂 ， 减 小 动静 摩 掠 的 差 值 ; 

(3) 采 有 出 适当 的 控制 补偿 方法 ， 对 摩擦 力 〔 插 ) 进行 补偿 。 

有 关 摩 氛 建 模 及 动态 补偿 控制 技术 方面 的 研究 具有 近 百 年 的 矶 史 ， 但 由 于 当时 控制 理论 
和 摩擦 学 发 展 水 平 的 限制 ， 使 得 这 方面 的 研究 一 直 进展 不 大 ， 进 入 20 世纪 80 年 代 以 后 ， 这 
一 领域 的 研究 渐渐 活跃 ， 许 多 先进 的 摩 护 横 型 和 补偿 方法 被 相继 提出 ， 其 中 许多 补偿 技术 已 
经 在 机 械 何 服 系统 的 控制 设计 中 得 到 了 成 功 的 应 用 。 

在 伺服 系统 辨识 中 ， 选 择 一 个 合适 的 摩擦 模型 是 非常 重要 的 ， 实 践 表明 ， 采 用 简单 的 库 
仓 摩 控 + 粘 性 摩擦 作为 摩擦 模型 ， 其 效果 并 不 理想 。 上 日 前 ， 已 提出 的 摩 控 模 型 很 多 ， 主 要 有 
Karnopp 模型 、Lugre 模型 及 综合 模型 。 其 中 ，Lugre 模型 是 Canudas 等 在 1995 年 提出 的 典型 
何 服 系统 的 摩擦 模型 55， 该 模型 能 够 准确 地 描述 摩 探 过 程 的 复杂 的 动态 、 静 态 特性 ， 如 慌 行 
《Stick Slip)、 极 限 环 振 荡 (Hunting)、 滑 前 变形 《Presliding Displacement)、 摩 氛 记 忆 (Friction 
Memory )、 变 静摩擦 (Rising Static Friction ) 及 静态 Stribeck 曲线 。 




















9.1.2 伺服 系统 的 Lugre 摩 氛 模型 


Lugre 摩擦 模型 可 描述 如 下 : 
对 于 伺服 系统 ， 用 下 面 的 微分 方程 表示 : 
J6 = wu- 忆 (9.1) 
式 中 ，y 为 转动 慑 量 ，6 为 转角 ，& 为 控制 力 先 ，F 为 摩擦 力矩 。 设 状态 变量 z 代表 接触 面 凤 
毛 的 平均 变形 〈Bristle Deform)， 则 成 可 由 下 而 的 Lugre 模型 来 描述 : 


不 =Goz+GIE+TCB 《9.2) 
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:6_-cal6l。 
SC) 
1 


GO)=FAR Jelsi + 28 





(9.3》 


《9.4》 


在 式 〈9.2) 一 式 〈9.4) 中 ，ao 、Gi 称 为 动态 摩 壤 参数 ， 玉 、 已 、c 、 必 称 为 静态 摩擦 参 


数 ， 其 中 乓 为 库仑 摩 掠 ， 玉 为 静摩擦 ，C 为 粘性 摩 氛 系 数 ， 愉 为 切换 速度 。 
控制 器 采用 PD 控制 的 缘 式 。 


9.1.3 仿真 程序 及 分 析 
仿真 实例 


在 何 服 系统 ( 式 (9.1)) 及 摩擦 模型 〔 式 92) 一 式 9.4)》 中 ， 取 大 10，au =260， 


ai =2.5，a =0.02， 到 =0.28， 下 =0.34， 取 =0.01。 取 输入 信号 为 正弦 信号 。 


仿真 方法 一 : 采用 M 语言 实现 控制 算法 及 带 有 摩 氛 模 型 的 被 控 对 象 的 描述 














采用 PD 控制 ， 取 已 =50 :后 =0010 。 图 9-1 和 图 9-2 为 位 闭 和 速度 跟踪 的 仿真 结果 。 
在 速度 过 零点 时 ， 波 形 发 生 畸 变 ， 出 秽 位 置 跟踪 “ 平 顶 ”现象 和 速度 跟踪 “处 区 ”现象 。 
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主 程序 ，chap9_1.m。 
外 BID ContLIol PaseQG on Dugre frcctior moac- 
CILeaT -1 


close al 


LSs=0.0817 





= 


GqG=zeros ft3 1) 7 





EL 


七 ime (KK) =KxfS7 
Yinfk)=0.05*s2ni0. *2xDPiskxcSh7 


aGrin(k)=D-05* 昌 -1*2yxDpirceSsrD yxyrPirkres) 37 


sLugre friction moael 
[ttv,yy]=cdel5sl'chap9_]eg' [0 ts],qG, [aa ll 
qq=yyIlengthtyyy 17 

yout (xj=agtll1 

Y21K)<GGE2) 7 


utk) =50w trintk)-yout (xl)ro-010* (arinfk)-y2(k) ts 
U_L=ufk) 

eaa 

Tiguret1l17 


plot (fime, zin rr' ytimey yout Pb') 7 





X1abelf ime Sjtion tracking' 1) 1 





yzlanel( 
f:cnaret237 
PloL tisesarir xz vtimey2， bb 


xiabeli'tinels)' :ylabeli'Speeqd bracking' 7 


摩擦 异型 子 程序 ， chap9_leqme。 


furction ay=dqymlty, fagvuk) 








仿真 方法 


在 8 冰 数 才 





采用 Simuljink 仿真 
1 实现 Lugre 摩 氛 模型 的 
和 撑 制 力矩 的 变化 ， 且 运行 速度 快 
km20， 直 =50。 仿真 站 








仿真 可 很 容易 





地 作出 位 置 耻 跌 、 摩 氛 力 垂 
凡 rr)=0.1sin(0.2rr 度 )。 采 用 PD 控 


[为 205。 位 置 和 速度 女 踪 ， 产 探 力 乱 、 控 制 力矩 的 仿真 结 






疼 9.3 一 图 9.6 所 未 





由 9.3 PLD 的 个 轩 








“381。 





疼 和 5 





图 9.6 


初始 化 程序 ，chap9_2im 


S 甬 数 摩擦 模型 程序 ，chap9_2s.m 


倚 控 力 第 的 变化 


控 撩 力矩 的 变化 


[sys,x0,str,rs]=mdlInitializeSizesy 
case 1， 
Sys=mG1Derivatives tt,x,ul; 
case 3， 
SyYs=malOutputs{t,xvu) 7 
Case {2，4,91} 
SYS=[] 
otherwise 
error(['Unhaneled flag = ',num2str (flas) 72) 


emnq 


function [sys,x0,str,Ls]=mdlInitializeSizes 
sgizes = simsizesy 
sizes.NumcontStates = 37 
sizes.NumDiscScates = 0; 
sizes.Numoutputs = 3; 
sizes,NumInpuEs = 17 
sizes.DirFeedthrough = 1; 
工 


sizes.NumSarp1leTimes = & AL least one sample Time is neeqeq 


sys = simsizes(sizes); 
x = [05037017 

Str = [ 

Le = i00]7 


functton sys=mdlDeTivatives(t, Xu) &LuUSTe moael 


global JJ rou0 roul af 


EC=0.28: 
FS=0.347 
VS=0.017 


8Ref :piq_fm_eq .mm 
g=Fc+(Fs-FC)xexp(-(Xt2) /vs)^2)+afxXx(2)7 
Sysf13)=xt2)-(Tou0xaps(x(t2))79)*x(3)1 
F=rou0xxt3)+rouLxsys(3)+afxxt2)7 
SYSs11T)-x(2) 17 

sys(2)}=1ZJx*(u-F)7 多 ImPOTEaIL 上 


function sys=mdalOutputstt ,Xu) 
Sys11)=X(L) 7 多 AnG]e 
gsys(2)=xt2);  %angle Speed 
SYS(3)=X(3) 7 可 己 








Simulink 主 程序 ，chap9_2.mdl， 如 图 9-7 和 图 9-8 所 示 。 
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图 9-8 摩 氛 异型 的 Simutink 子 程序 
9.2 ”基于 Stribeck 摩擦 模型 的 PID 控制 


9.2.1 Stribeck 摩擦 模型 描述 


Stribeck 曲线 是 比较 著名 的 摩 探 模型 (59]。 如 图 9-9 所 示 ， 该 图 表明 在 不 同 的 摩擦 阶段 ， 
摩擦 力矩 与 速度 之 间 的 关系 ， 该 关系 即 为 Stribeck 曲线 。 





几 9-9 摩擦 -速度 稳 态 关系 曲线 〔Stribeck 曲线 》 
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Stribeck 摩 探 模型 可 表示 为 ; 
当 jgaol<w 时 ， 静 摩擦 为 ; 
天 开门 > 天 
下 (=1E( 人 人 一 Fi< 开 < (9.5》 
一 天 天 (站 < 一 En 
当 ol>w 时 ， 动 摩 探 为 ， 


瑟 GD= 人 二 (同一 忆 )eralee jem6m) 人 6 (96) 


产 站 = /6(D) (9.7》 
式 中 ，FGD 为 驱动 力 ， 瓜 为 最 大 静摩擦 力 ， 瓦 为 库仑 摩擦 力 ， 大 为 粘性 摩 探 力矩 比例 系数 ， 
6(D 为 转动 前 速度 ，e 和 上 为 非常 小 的 、 正 的 常数 。 





9.2.2 ”一 个 间 型 伺服 系统 描述 


以 飞行 模 扒 转 合 伺服 系统 为 例 ， 它 是 三 轴 伺 服 系统 ， 在 正常 情况 下 可 简化 为 线性 一 阶 环 
市 的 系统 ， 在 低速 情况 下 具有 较 强 的 摩 撑 现 象 ， 此 时 控制 对 象 变 为 非 线 性 ， 很 难 用 传统 控制 
方法 达到 高 精度 控制 。 任意 框 的 何 服 结构 可 表达 为 如 疼 9-10 所 示 的 形式 ,该 系统 采用 直流 电 
机 ， 忽 略 电 枢 电感 ， 电 流 坏 和 速度 环 为 开 环 。 

其 中 开 为 PWM 功率 放大 器 放大 系数 ， 尺 为 电 枢 电阻 ,天 为 电机 力矩 系数 ，C。 为 电压 
反馈 系数 ，v 为 该 柜 的 转动 懂 基 ，6(D 为 转速 ，r(D 为 指令 信号 ，x(D 为 控制 输入 。 

根据 何 服 系 统 的 结构 ， 飞 行 模拟 转台 位置 状 态 方程 可 描述 如 下 : 
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3 一 一 ae | 丽 。 一 电 二 
CD 0 控 (CD , 加 
式 中 ，( 人 =6(D 为 转 朋 ，x(D =6(0D 为 转速 。 
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图 9-10 飞行 模拟 转台 们 服 系统 结构 


9.2.3 仿真 程序 及 分 析 


仿真 实例 
设 某 转 台 茶 框 伺服 系统 参数 如 下 : 


"385"， 





R=7779，Ku=6N.mA，C。=12V/rad/s), JJ=0.6kg,m?， 
KE =1IVAV, 忆 =13Nm.P=20N.m ks =20Nms/rad, al =1.0. wx=0.01 
S 为 侍 号 选择 变量 ， 其 中 8 =1 为 正弦 信号 ，S= 2 为 阶 跃 信 号 ，38 =3 为 方 波 信号 。 本 仿 
真 选 取 $ =1， 低 速 正 弦 跟 踪 信 号 指令 为 xD)=0.10sin(2rb 。 
采用 PD 控制 ， 
(六 =200e(D+40e(D) 
针对 仿真 方法 一 ， 假 设 何 服 系 统 无 摩擦 ， 即 取 H =0， 此 时 五 们 =0， 采 用 PD 控制 ， 
速度 和 位 置 跟踪 结果 如 图 9-11 和 图 9-12 所 示 。 仿 真 结果 表明 ， 无 摩 氛 时 ， 采 用 PID 控制 方 
法 具有 较 好 的 控制 效果 。 
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图 9-11 无 摩 掠 时 的 位 置 跟踪 CHMH=0) 
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1.5 
timelS) 
图 9-12 无 摩擦 时 的 速度 跟踪 
当 j =1 时 为 带 有 摩擦 环节 的 PID 控制 ,仿真 结果 如 图 9-13 一 图 9-16 所 示 。 仿 真 结果 表 
明 在 带 有 摩 撩 条 件 下 ， 位 置 跟踪 存在 “ 平 项” 现象 ， 速 度 跟踪 存在 “ 死 区 ”现象 。 采 用 PID 


控制 鲁 棒 忻 养 ， 不 能 达到 高 精度 跟踪 。 
针对 仿真 方法 一 ， 仿真 程序 如 图 9-17 所 示 。 带 有 摩擦 环节 的 PID 控制 仿真 结果 如 图 9-1& 
和 图 9-19 所 示 。 仿 真 结果 表明 在 带 有 摩 护 条 件 下 ， 位 置 跟踪 存在 “ 平 项 ”现象 ， 速 度 扫 跌 在 
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在 “ 死 区 ”了 现 银 。 采 用 PID 控制 鲁 棒 性 差 ， 不 能 达 伸 山 精 度 跟 踪 。 
通过 对 两 种 仿真 方法 进行 比较 ， 吕 知 采 用 基于 $ 函数 的 Simulink 仿真 具有 编程 简单 、 运 
行 速 度 快 、 对 中 间 变 量 作 图 方便 的 特点 。 
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图 9-13” 带 摩擦 时 的 位 置 跟 足 〈《M=1) 
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图 9-15 摩擦 力 五 ( 的 变化 
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到 9-16 带 摩 擦 时 控制 器 的 输出 


仿真 方法 一 : 采用 M 语言 仿真 

仿真 程序 : chap9_3.m。 

%PID Control with Stribeck Friction Model 
clear al]; 

close al1; 


global wRAalfadJceRFKnFKuSal FmFcMKV 


&%8Servo SYStem ParametetrSs 
J=0.6;Ce=1. 
Ku=1I; 








W=1x*2*pi7a=0O-107 


已 了 aa=0.0117 


T=3-0; 


te=<0.001; ssSampling time 
TimeSet= [0:ts:T]7 


HM=07 $IE M=0O，NO Eriction works 
8S=17 

[kt,x]=cqe45{' chap9 3f vejmeSet, [0.0,D])7 
X1=Xf:， 1) 7 

X2=xf: 7 2) 1 

X3=X(: 7 3)7 

E S==1 





工 主 m = 六 二 名 Tm WE 7 


rin=Rxwscos(wsc) 1 
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Qdrin=-RyWYwWASTnTWwx) 7 





CITTRE=TIn-XL: 1) 1 
GerTDIT-qrin-xf3y 217 
En 
3f 5== 


Eor KK=] :13:9ZLB+1 
TiITCKK) -1 
rinfKkK = 
Qarinfkk)=0: 
erTOF (KK)}=YrIRIKKT-XLIKK) 1 
QerrorIkkJ=Grin(kK) -X20KK) 





end 
eng 
iT 3S==3 

Sor kk=1:1:T7Lstl 

rin=axsigntsint0-4*32wpoiwt))7 

dcintkkl=oy 
adrin (kk}=07 
errorlkky -rimtkk) x1(KK》 
derrortkk) -azin(kk)-x2fkk) 7 








X2=xt:v 
Tor KKk= 
二 me tkk)={KE-  )》 二 代号 





if absfx2 fkK))<=alfa 
了 FIOgkK) >Pe 





SEE{KXI=bm7 
e] SeiE 上 (kk)< -FT 
ET 工 (KK) = 一 上 功 7 
马 ] 人 所 


EE (kk)=TIKK 
ED 包 


enma 


了 EX2 (KKk)>alFa 
FE(kk)=Fc+(Fm-FC)rexpPt-alrx20kKk))+KVwAX2CKK) 7 
CISeiLT X2 (KK)< 去] 工 a 
FEtkxj=-rc-tsm-EFClrexp(alyXx21kx))rkKVrX2CKK) 7 
end 
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iE M== 
Ff(kk)=0; ggNo Friction 
enga 


UKkk)=200*error (kk)+40*aerror(kK) 7 多 PID_ Control 


ifE utKK)>=10 
utkk)=10 
ED 
if utkk)<=-10 
utkKk)=-]07 
end 
enq 
figure(t1] 
PICE 人 Fi IIK 7 LC，)， 区 ) 
xlapelt'time(s)')iylabelt'position tracking') 7 
figuref2)7 
了 1ot 全 Qin KE XI 2) KK 
xlabelf'timels)')rylabel('speeQ tracking' ) 7 


EiSuret3) 7 

Ploc (Et ,errOL，'K' 了 
XIlabel1'time(s}')7YyLabelf'erTor ] 7 
figoref(d) 7 

Blot(x(: 2) FI K' 1) 
xlabelt'speed')yylabel('Friction') 
figure(5) 7 

BRLOE EPE， K) 7 
xlabel(t'bime1s)')*ylabel('Friction' ) 7 
figurel6) 1 

PLoL (time uk) 

xlabel('time(s)') ;ylabelltu' 


子 程序 :chap9 3f mo。 

function ax=Modelft,x) 

global w RalfadJceREnKuSalzFm FEcMkv 
persistent aa 


Qx=zerosi3,1) 1: 


ali=1.0; %Eftect on the shape of friction Curve 
FEm=201 
Rc=153， 
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GF=J*aa 


iabs(xt2))<=BalLfa 
E 了 >Fm 
TE=Tmy 
GFE=D1; 
elseif F<-Fm 
FE=-Emy 
GdFf=D; 
else 
FE=P; 
dgFf=GQF 
enQ 
em 
定 E Xt23) >a]Faa 
FE=PC+fFm-Fc)*expt-alxxt2))+kvAxr2) 17 
GFf= (Fm-PC)Yexpt-alxx(2)]w1-al)*Xt3)+KVtXt3) 
elSeif 区 (2)<-alLEa 
FL=-~Fc-{(EFEm-Fc)*exptalxx[I2))+kvtxf2)7 
QFf=-(Fm-EFCc)*exptatxxf21))》*al+Xl3)+KVxX(3)》 


End 


IE S==1| 
Tin= 玉 xSEmn (ww 七 ) 7 
qdrin=axwxCOStwxA) 7 
Qdrin=- 有 <WYWx 台 计 m CCWY 证 ) 


Gdgdgrin= &xwxwxWwnCOS (YY 七 ) 1 


engQ 





Qarim=0y 
aaarin=07 

end 

IE S== 
in=arsigmnlsin(0.4x2xpiwt) 1 


Qr2>nD=03; 
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aarin=01 
aadrin=0; 
emQ 
所 rror =rin-X(1) 
Qerrer=Qrin-X(2) 7 
Gdqerror=dqdrin-x(3) 上 


D=200*erIOF+SOAQerTOLT 当 PID 


Gu-200*+dqerror+40+raqdecrror 


E u>=110 
u=1107 

ED 已 

iE u<=-~110 





7qFT=0; 8%ND Friction 


XI1L) =X12) 
Qx 2] =-KmxrCeA (JI*R)x*Xt2)+KU*KmxuA JsR) -PEAT; 
Gx(3) =-KmxCe/AtJxR)xx(3)+KuxKmxduyA(JxR) -GEFf/A7 


已 a=GX{3) 7 


仿真 方法 二 : 基于 S 函数 的 Simulink 仿真 
采用 8 函数 实现 对 象 必 摩 擦 模型 的 表示 及 位 置 .速度 和 摩擦 力 的 输出 .仿真 结果 如 图 9-17 
和 图 9-18 所 示 。 














Position tracking 








2 25 3 


1.5 
time(s) 
图 9-17 带 摩擦 时 的 位 定 则 踪 
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Speed tracking 




























































































































































































-1 一 - 
0 0.5 1 1.5 2 2.5 3 
timet(s) 
图 洒 18 带 摩 插 时 的 速度 跟 帆 ' 
仿真 程序 ，chap9_4.mdl， 如 网 9-19 所 示 。 
ud ouat| 必 
已 浊 站 Mux napa_aplant beamux CT 
国 国 同 相生 本 扼 | chaps_a3pl | 
5 Sa 
eansyater Sm 。  PID 的 机 
Contallerl 
wx 上 加 
人 ToWEISace2 
Mux | | 轴 
的 To wentspace3 
Dernrative aoc 
4 
Claek To Wolspace 


图 9-19 Simulink 仿 具 程序 


被 控 对 象 $ 函数 子 程序 ，chap9_4plantm。 
furctiorn [sys,x0,stz,ts] -= spacemodcl (txyavfiag) 
switch Elag， 
case 0， 

[sys,x0,strvt3sl=rd]Tnitializegjzes: 
case 1， 

sys-mdlperivatives (Exru)i 
case 3， 


sys=nmdl0utpussft, xu) 
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Case fi2,4,9] 
SYS=[] 
Otherwige 
erorit[i'Unhandled flag = ' ,num2strfflag)]) 


end 


function [SYSs,X0,Sttr,tsj=mdalInitializeSizes 
Sizes = Sirmsizesi 
sizesa.NumContSrates = 2 
Sizes .NumDiscStates = 了 效 : 
sizeg ,NumOutputs = 3 
sizes .NumImpUES = 2 


sizes .DirFeedthrough = 


工 
sizes -NumSampleTimes = 1) % At least one sample time is meeded 


sys = simsizeslsizes): 
x0 = 50750]: 

str = []; 

ts = !0 017 


ftunction sys=md1Derivatives (txvu) 


名 SerVvCO SySLem FaralteterS 
J=0.67Ce-1.2:Km=67 
Ku=117;R=7.777 

KKv=2.07 


已 1 于 二 = 人 .01 

alL=1.0; %Effect on the shape cf friction CUVe 
FEm=207 

了 FC=157 

Jkv=2.07 


下 =Jxuft) 7 
1E abs(xt2))<=alEa 
E FF>Fm 
FE=Emmy 


elseif PR<-Frm 





if xt2)>alfa 
FEf=Fc+ (Fm-FC)xexp(-alsxt2) )+KVYxX12117 
elSeiE xt(2)<-alfa 
FE=-FC 一 FEm-EC)*exP(aty*X(2)》)+KVeX(21 
end 


SYSs{]1]=x(2)1 
Sys(2)=-KmwCeA (J*Rh*X[21]1+KurEKmeuK21A IJT*R) -FEAT7 


Eunction sys=mdlCutputs (cv xD) 


遇 Servo SYSterm PararteterS 
UJ=0.6;Ce=T.2IKm=67 
Ku=117R=7 .77: 

kv=: 





己 开 a=O -017 

al-1.0; &%Effect on the shape of friction CurVe 
Fm=20D17 

FC=15; 

kVv=2.07 


下 =JAn (IT) 
FE abs(Xx(2))<=alfa 
了 人 下 >EFm 
FE=EFmy 
elLseiE F<-Em 


FE= 一 Fmi 





end 

E X(2)>alfa 
FE-FCc+(Em-PC)*exp1(-alxXt2))+KVAX(2) 7 

elseif x(2)<-alfta 


Ff-=-FCc- (FEm-FC)xexp1alxx(2))+KVAX(2) 7 


end 

SYS{t1)}=X(ILTT1 S%RAngIe 
Sysf2)=X(2)7 g%RnGle SPeeQ 
SYSTK3)=F 开 ; $Friction force 
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作 疼 程序 : chap9_4plotm。 


close al17 


figmnretI) 

PILEt yt ) kbyty2)，k) 
Xubelf'binrels)' ylabel('Pcsi=ion Trackirg') 7 
fiSure(21 7 


了 LIOL (FE(: 1) FE 2 和 7 


xlabelf' angle speed') ;yl1abel('Fricricon [orce' 


于 GUYe(31 
DPlot(tygyl: 1) KityGyt:v 2 kk 
xlabelt'timela)'))iy]abe:('SBeed tracKking' 7 


9.3 ”伺服 系统 三 环 的 PID 控制 


9.3.1 伺服 系统 三 环 的 PID 控制 原理 


以 转 合 何 服 系统 为 例 ， 其 控制 结构 如 图 20 所 示 ， 其 中 ”为 枇 架 参考 角 位 置 输入 信号 ， 
























































8 为 输出 角 位 置信 号 。 
六 上 位 置 环 十 速度 环 执 行 机 构 : 
控制 味 | 一 技 制 器 必 和 和 省 
速度 到 
镇 元 件 | 














图 9-20 ”转台 何 服 系统 样 图 
何 服 系统 执行 机 构 为 典型 的 盲 流 电 动 驱动 机 构 ， 电 机 答 i 
使 系统 具有 较 好 的 速度 和 加 速度 性 能 ， 引 入 测速 机 信和 分 
换 装 置 构成 数字 式 角 位 置 何 服 


式 速度 回路 。 由 高 精度 轴 感 应 网 步 器 与 数字 变 





1 轴 下 按 与 负载 -转动 轴 相 连 ， 为 
作为 系统 的 速度 反馈 ， 直 接 构成 模拟 





了 





路 。 








转台 何 服 系统 单 框 的 位 移 环 、 速 度 环 和 电流 坏 框图 如 图 9-21 、 图 9-22 和 图 9-23 所 示 。 








二 了 


自 











谴 度 环 














| | 。 深 抽 器 














图 9-21 和合 服 系统 位 置 坏 框图 
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六 名 四 中 流下 感 


太 ， 
































图 9-22 们 服 系统 速度 环 杠 网 


天， 
机 上 -| -| 和 了 


赂 9-23 舍 服 系统 电流 环 栓 图 
图 中 符号 含义 如 下 :为 位 置 指令 ，8 为 转台 转角 ;六 为 PWM 功率 放大 倍数 ， K。 为 
速度 环 放大 倍数 ， 天 ,为 术 度 环 反馈 系数 ， 天 ,为 电流 反馈 系数 ， 工 为 电 枢 电感 ， 尽 为 电 相 电 
阴 ， 天 。 为 电机 力 敌 系数 : C。 为 电机 到 电动 势 系数 ，, 为 等 效 到 转 加 | 的 转动 慌 量 ;8 为 粘 
性 也 尼 系 数 ， 基 中 了 = JJ + ，B=B +，Jm 和 上 几 分 别 为 电机 和 负载 的 转动 惯量 ， 因 和 
六 分 别 为 电机 和 负载 的 粘性 阻 屁 系数， 和 为 扰 卉 力 饶 ， 包 括 摩擦 力 第 和 耦合 力 抵 。 
假设 在 速 度 环 中 的 外 加 干扰 为 粘性 摩 擅 模 型 : 















































五 人 = 乒 :sgn(6)+ 吧 :6 (9.9) 
控制 点 采用 PID 控制 + 前 馈 控 制 的 形式 ， 加 入 前 馈 摩 探 补偿 控制 表示 为 : 
af (二 到 sgnf6)+B :全 (9.10) 


式 中 ， 瓦 ; 和 久 ; 为 得 性 摩擦 模 型 等 效 公 位 置 环 的 估计 系数 ， 该 系数 可 以 根据 经 验 确 定 ， 或 根 
搓 计 算得 出 。 


9.3.2 ”仿真 程序 及 分 析 


仿真 实例 
被 控 对 象 为 一 个 具有 一 环 结 构 的 伺服 系统 。 何 服 系统 参数 和 控制 参数 在 程序 中 给 出 描 
述 ， 系 统 采 样 时 间 为 Ims。 到 M=2， 此 时 输入 指令 为 正弦 玖 加 信和 号， 
rD= 4sin(2mFD)+0.54sin(l.0rFD)+0.254sin(0.5rFz) ， 其 中 4=050， 忆 =0.350。 
考虑 公开， 工 和 Ce 的 人 很 小 , 前 馈 补 偿 系 数 所 | 和 已, 等 效 到 摩擦 力矩 问 的 系数 可 近似 5 
2 Gain = 开 ,x 天 X1RRX 天 。X 天 。 
式 P， 故 。 为 经 验 系 数 ， 摩 所 模型 估计 系数 拷 | 和 及 为 : 
玉 , = 反 /Gain 
已 = 必 /Gain 
系统 总 的 控制 输出 为 
.397 ， 


OO= 加 人 + 人 
式 中 ， 王 提 为 FID 控制 的 输出 ， 其 三 项 系数 为 Ko =15， 


根据 是 否 加 入 摩擦 干扰 和 前 馈 补偿 分 别 进行 仿真 。 
初始 化 程序 ， chap9_5im。 


S%Three Loop et Fiight Simulator SerVvo System with Direct CuTrent Motor 





=0.10，ku =1.5。 


clear all1i 

close all; 

%(1jCurrent 1oop 

L=0.001; 8L<<1 inauctance of motor armature 
及 = 于 二 &ReSiStemce of motor arTmatUTe 


ki=0.0017 S%Current feedback coefficient 


务 (2)VEelocity 1ooP 


ka=67 %Velocity loop amplifier coefficient 

KV=27 8%Velecity Loop feedqback coefficient 

JJ=2: %Eauivalent moment of inertia of frame and motbor 
Pb=17 SViscosity damp Coefficient of frame and motor 





jkm=T -07 MDtor moment coefficient 


Ce=0.001: $%Voltage feedback coefficient 


&EFriction model: Coulomb&gViscous Frictiocn 
Fc=100.0;bc=30.0; $Practical frictiomn 


多 (3)》Posicion Toop: PID control1eI 

KU=JTIL7 &%Volitage amp1lifier Coefficient Of PWM 
KPP=1507 

Kii=0O-17 

kadq=]1.57 


sFriction Model compensation 
%Ecuavalent gain from feedforward to Practical friction 
Gain=kuxkqdx*17RwkmxI.07 


Fcl=FcyGain1y bc1l=bcyGain; gFeedforwarG Compensation 


InPut signal initialize 
-507 
Rs=0O-507 


上 = 





ts=0-001;  %Samp]ling 上 ime 
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1T M== SSine Signe1 
k=50005 


[ime-iu: 





3 上] 





Tin-axs2nt2xDi*F*Lime》 > 


GT mn=2xDDivb*AsCC 








elself R==2 5gRandorl 31gnal 
T=49991 
Time=-ZEros (11 
Fin-zeroslT 1 


grin=zerosftT, 1)7 





grint 


Eor kk=1:13:2 





Limetk~:)=Kxts7 
员 Razrgaom Sigzmal 
rin (xiy-axsin(2*DiyF+kstS)+0 .5wRAxSjint2xPpixr0.SYE*K*S) 十， 
和 .25*Axein(2x* 记 ix0,25*Fx 攻 +tS) 1 
arinltxr2zy=(rin(k+1)-rintk))Arsy 
ET 


er 


控制 系统 的 Simulink 程序 ， chap9_5.mdl， 如 网 9-24 和 图 9-25 所 示 。 











em 
Waspace1 





2 zaroGrder 
Hold2 


FI 


euepace PID Centoller 





呈 - 


ZereDrder 
Hald3 


Peston Loop 


铬 9-24 。: 环 控制 的 Simulink 仿真 程序 
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入 927 。 谍 焉 司 如 信 生 这 度 昌 
生 如 信和 导 违 度 申 中 【无 章 捧 无 前 馈 补 偿 》 


旨 的 仿真 。 正 续 登 如 信和 叶 跟 踪 
正 1 了 归 踪 如 图 9.28 和 图 9-29 所 示 ， 直 于 静 
踪 存 在 “ 死 区 ”现象 





位 置 跟 踪 存 在 “ 平 项 ”现象 





图 3 纸 香 加 信 身 位 首 
置 中 总 【 吉 摩 捧 无 前 局 补偿 ) 








员 度 绰 踪 【各 阶 和 
度 绰 跨 【 害 摩 探 无 前 馈 补 傍 


图 929 下 强 







由 图 小 30 和 好 9-31 所 示 , 采用 PITD 
“ 平 项” 和 速度 跟踪 





开 蹊 基 





了 位 置 眼 踪 的 





控制 如 前 镇 控制 
的 “ 死 区 "， 实 现 了 较 高 的 人 
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图 931 正弦 绿 加 信号 违 度 良 踪 〈 推 摩 欣 丰 前 协 补 怪 ) 


9.4 二 质量 伺服 系统 的 PID 控制 


9.4.1 二 质量 伺服 系统 的 PID 控制 原理 





如 果 体 服 系统 把 电机 与 负载 作为 一 个 
际 特性 有 很 大 差别 。 对 于 
而 且 轴 承 和 性 架 也 都 不 完全 是 刚性 的 。 在 电机 枢 动力 矩 
z 变形。 对 于 加 速度 要 、 人 快速 性 和 精度 责 求 高 足 转 动 屠 量 大 、 人 性 能 要 求 高 

弹性 变形 对 系 儿 影响 才 出 于 传动 铀 的 栖 砧 和 变形 ， 在 传递 运动 时 含 
藻 元 件 。 如果 速度 阻尼 小 ， 则 在 它 的 传递 特性 中 将 出 现 较 商 的 机 械 谐 报 ， 此 谐振 对 系统 
的 动态 性 能 影响 较 太 - 因此 民 j 象 视 为 图 9.32 所 示 由 电机 、 姜 民 性 负载 及 连接 二 者 的 


等 效 传递 轴 所 组 成 的 三 质 
He 


关 9.32 电机 - 优 动 铀 - 俩 埠 横 告 


根据 图 9-32 可 得 传动 轴 动 力学 方程 ， 根 据 伺服 系统 电机 框图 【如 图 9-33 所 示 ) 可 得 电机 
电力 学 方程 ,根据 伺服 系统 负 示 框 图 (如 图 9-34 所 示 ) 《不 关 虑 干扰 时 ) 可 得 负载 动力 学 方程 





阳 体 米 





僻 服 系统 ， 读 系统 与 实 
， 但 传动 本 质 上 是 弹性 的 ， 
区 作用 下 ， 机 械 轴 会 受到 某 种 程度 的 



































本 石 | 
Lo 


用 外 33 和 何 县 系 病 电机 栋 半 
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工 >| 一 ! 工 频 
vsr 击 Y 


网 9-34 ”伺服 系统 负载 框图 
三 质量 伺服 系统 的 电学 方程 和 动力 学 方程 为 : 














证 + 厂 = 本 一 C6 -Ki (9.11) 

电机 
To = 大。 《9.12) 
Jan6 = Ti 一 bug6 -天 (9 -iD) (9.13) 
传动 轴 Js(G 一 责 )= 天 (8 一 6) 一 Ta 《9.14) 
负载 JU6 =Tu 一 上 6 (9.15) 





式 中 ， 了 7。 为 传动 轴 的 转动 惯量 ，6。 和 6 分 别 为 电机 和 负载 的 转角 ，Ja 和 上 六 分 别 为 电机 和 
负载 的 转动 惯量 ， 久 和 访 分别 为 电机 和 负载 的 粘性 阻尼 系数 ， 天 (为 电机 和 框架 之 间 的 耦合 
刚度 系数 ，Tur 为 负载 端 输出 力矩 。 

一 般 交 相对 于 六 很 小 而且 其 质量 分 布 在 轴 的 长 度 上 ， 因 此 可 以 忽略 或 计 入 到 中 ， 
于 是 上 述 三 质量 系统 可 以 简化 为 二 质量 系统 .二 质量 系统 的 电学 和 动力 学 方程 为 ; 




















电机 证 + 五 = 下 一 C6 一 有 (9.16) 
各 = 大 《9.17) 

Ja6 =T 56 一 天 (9 一 6L)》 (9.18) 

负载 了 站 =T 一 6 (9.19) 
天 (9 -6 )-Tar =0 (9.20) 


根据 上 述 描述 ， 得 到 二 质量 伺服 系统 部 分 结构 框图 〈 其 余部 分 与 单质 量 伺服 系统 结构 相 
同 )， 如 轿 9-35 所 示 。 . 

















1 二 和 + 1 @ 
电流 环 如 +on |] 








如 ) 局 加 


1 
了 所 三 和 | 一人 盖 


图 9-35 ”二 质量 何 服 系统 部 分 结构 椎 图 






























































9.4.2 ”仿真 程序 及 分 析 


仿真 实例 
被 控 对 象 为 一 个 具有 三 环 结构 的 二 质量 伺服 系统 。 伺 服 系统 参数 和 控制 参数 在 程序 中 给 
出 描述 ， 系 统 来 样 时 间 为 lms。 
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输入 指令 为 正弦 信号 : rCD = 4sin(2rFrD ， 共 中 4=0350， 下 =0.50。 
假设 在 速度 环 中 的 外 加 工 扰 天 为 粘性 摩 氛 模 型 ， 瑟 (D= 尺 .sgn(6) + 六 :6 。 
控制 器 采 几 PID 控制 ， 参 数 选 为 ，Kpp =80， 和 后 =10，kad =5.0 。 

根据 总 和 否 加 入 涤 擦 干扰 分 别 进行 仿真 。 

蔬 始 化 程序 : chap9_6im。 


&Three Loop of F1ight Simulator Servo System with wor-mass of Direct CUTTeTL 











Mot or 
clear all1; 


Close all; 


8(L)Current loop 


L=0.001; 8L<<1, Inguctance OF moLoTr armatur 所 
R=1T-D7 和 Resistence of moter armature 
KiI= 台 -0017 &Current feedback coeffticienc 


g#{3) Velocity loop 


jdq=67 SsVelocity Loop amplifier coefficient 
JEv=23 gwelocity Loop feedqback coefficient 
Jm=0.0057 SEEcquivalent moment of inertia of motor 
jpm=O.0107 虽 Viscosity damp Coefficient of motor 
km=107 多 Motor moment cocfficient 

Ce=0.0017 &%VDlcage feedback Coefficient 

J1=0,.157 和 BaGuivalert morment cf inertia of Erame 
Db1L=8.07 要 Viscosity damPp coeftfjcicnt cf frame 





&Motor moment coefficicnt between frame and motoL 


SFTiction mcade1l: CoulombgViscous FTICLIOT 


Fc=10;bc=3; %Practzcal frictionm 


&(3)Position loop: PID controlLer 


ko=11: sVolcage amplifier coefficient OF PWM 
KPpp-87 


kii=1.07 
Ga=51 


.404 





Input Signal Initialize 
FE=0.5017 
R=0.501 
La-0.0 





多 Sampling 七 ime 


K=50007 


上 ime= 





:SikxtSsl 7 SiTRlLatiOn 上 ime 


Fin=axsjint2*rpisFxsime) 7 


arin=2ypiyFwarCost2*DpixvFxtime) 


控制 系统 的 Simulink 程序 ，chap9_6.mdl， 如 图 9-36 一 图 9-38 所 示 。 
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疼 9%-36 二 质量 伺服 系统 三 环 控制 的 Simuliok 仿真 主 程序 
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图 9-37 广义 被 控 对 象 的 Simulink 仿真 程序 
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孩 位 转帐 入 


寺中 跌 侍奉 








| 
Siowliak 的 真 
二 的 结果 如 图 9.39 种 陨 9-40 所 元 





入 速度 上 昭 路 1 无 麻 





页 ”现象 ， 速 度 跟踪 存 志 


区 的 关 果 如 图 9.41 和 图 9-42 所 不 ， 


”现象 


由 于 薄 摩 控 








呆 用 PD 如意 包 控制 方式 ， 设 计 的 控 剧 律 妨 下 
WwW= 此 [大 0r 一 86) 一 大 B1+ 万 r+ FF 才 一 大 日 + 太 r FF 931 
式 中 ， 太 三 后 k， 兰 大 类 E = 太一 自 
由 疼 9-.43 中 可 
1 6 
JE+b 
册 
JJB+bD = 
式 ， 特 








JE+(K2+D+AsO 


J>0.ky+ph>DA>O 
则 根据 代数 稳定 性 剂 据 ， 针 对 阶 系 统 而 吉 ， 统 俐 环 特征 方程 式 的 系数 都 大 于 零 时 ， 系 
系统 的 跟踪 误差 etf) 收敛 于 零 


册 








935.2 仿 喜 程序 及 分 析 


仿真 实例 
被 拉 对 旬 为 一 个 具有 三 环 结构 的 何 服 
系 斑 答 六 信号 的 采样 时 间 为 tms， 答 和 


数 科 探 刺 人 多数 在 程序 中 给 出 并 
导 ; ni= Asin(2rF0 ， 其 中 













J=2Z0kg.m3， hs0350, 大 =20， 
] 轩 9.4 一 图 9-.46 所 本 





=10， 丰 =10:M00) 为 控制 履 





妃 = 瑟 ， 上 =6,， 则 万 =4+ybh， 1 ， 仿 共 : 





“408 





9-45 位 置 跟 踩 师 罗 





初 巡 化 程 座 ，chap9_7i.m 


“09 * 


FE2=J} 


Fli 
Ah=1; 


t<[0inDui:in1 1 SSimulaclon ime 
FnAsSim13oBaAPeE) 
ar=2*pjivFekecos12vpleFo5) 7 


ar= -kspinptnFeFehesinh(2sDisFeL) 


主 程序 ，chap9_7.mdi， 如 图 9-47 所 示 * 





Peer Lenp 


图 9.47 Simwlink 主 程序 
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这 _- 立 - 让 、 
第 10 章 ”机 器 人 的 PID 控制 
针对 单 错 机 械 王 的 机 器 大 控制， 中铁 龙 教授 针对 傅 定 性 和 不 确定 性 单 璧 由 械 手 ， 分 别提 
出 了 一 种 基于 “PD+ 前 镇 ”的 控制 方法 和 -种 基于 “PD+ 明 镇 ”的 名 棒 控 制 方法 ， 并 证 明了 
这 上 师 种 算法 的 稳定 忻 和 下 而 分 别 介 这 两 种 控制 管 法 ， 并 通过 仿真 进行 验证 。 


10.1 确定 性 单 臂 机 械 手 的 PD+ 前 馈 控 制 








10.1.1 单 辟 机械 手 的 运动 方程 
假设 和 达 村 的 质量 均匀 分 布 ， 质 心 距 连 杆 的 转动 中 心 为 六 连 杆 运 芭 的 粘性 摩擦 系数 为 小 
并 忽略 弹性 崎 掠 ， 则 根据 生 帆 定律 得 到 其 运动 方程 为 ; 
716+a6+msicos9=T 《10.1) 


式 中 ，mg 为 重力 ， 1=3m 为 转动 惯 是 。 


10.1.2 ”控制 器 的 设计 
设 希 望 的 轨迹 为 龟 ( ， 则 跟踪 





《10.2) 


设 误 兰 的 动态 特性 满足 特征 方程 ; 
e+ede+ae=0 (10.3) 





式 中 ，c， 万 为 贞 - 
根据 代数 稳定 忻 判 据 ， 针 对 二 阶 蔷 统 ， 当 系统 半 坏 特 入 方程 式 的 系数 都 人 于 零 时 ， 系 统 
稳定 ， 式 〈1!0.3) 的 跟踪 识 美 e(D 收 敏 于 至 。 
引入 辅 翅 控制 仿 导 zx， 考虑 公 前 馈 和 









8 +Tmaslcosg (10.4) 





开 一 到 十 
由 式 〈10.1) 和 式 〈10.4) 得 : 
玫 二 e+de 《10.5》 
外 式 〈10.3)》 和 式 〈10.5) 得 到 PD 控制 : 
U=(d-cor)e 一 pe 《10.6》 
痢 式 (10.6) 入 式 上 10.4)， 得 介 最 终 的 控制 律 为 ; 





T=(d-eane-bye+ 扩 +d6s+mglcosB (10.7) 
出 式 〈10.7) 可 见 ， 探 制 律 相当 上“PD+ 前 馈 榨 制 ” 


10.1.3 ”仿真 程序 及 分 析 


仿真 实例 
视 械 右 的 参数 为 闫 = lkg ，!1=0.25m ，d=20N.m:srad ， 控 制 问 参数 选 为 ac=20.0 ， 


.411 


五 = 25.0 。 指 令 信号 为 sin(2rz) 。 仿真 结果 如 图 10-1 一 














10-4 所 示 。 





总 04 关 一 一 一 - 


0.03 


0.02 


error 





4 
timets) 


赂 10-1 跟踪 误 莽 





1 


position tracking 





2 4 6 
timets) 


疼 10-2 ”正弦 位 置 跟 踪 
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口 


Speed tracking 


甸 











图 10-3 上 引 纺 速度 距 踪 
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4 6 
ftime(s) 





120 





100 


tot 


















































































































































2 10 
time(s) 
图 10-4 控制 器 答 出 
仿真 程序 由 以 下 四 个 程序 构成 。 
Simulink 主 程序 : chap10_1.mdi， 如 图 10-S 所 示 
人 攻 
。 
Clew Te Waspace 
TeWadspacef 
_| 
us 
拓 | durdt TeWionspaca2 
Deaniuatve 
广 -一 一 天 | 
ai | 
oa0 六 一 一 | 
Mux 上 划 | sap10 1 hap40_Tplant Demux To Waispaoe3 
St9nal [三 基 | 
Geneiator SFuneion SFunchon 














To Worspacesq 








函数 控制 程序 : chap10_1s.me。 


function [sye,x0vatr,cs' =- spaceroaelftx,uyflag) 


Switch 寺 lagy 
Case 0D， 
[sysy,x0,Skr,tsj=mdlIriktiaizjzeSsizzeS: 


Cas@ 3 


图 10-5 确定 条 件 下 机 相 辟 的 Simulint 主 程 序 


. 413， 





SYSs=mdlOutPutrs tt ,Xu 
case !2,4.9} 
sys=[] 
otherwise 
erroxr(f['Unhandled flag = ,num2stz (ftlagh]) 1 


enq 


function Tsys,X0,Sstzr,tS]=mdalInitializeSizes 
sizes = Simsizes7 
sizes-NumContStates = 如 


sizes .NumDiscStates = 0) 


sjzcBs.NumGOutputs = 工 
3 


Sizes .NumInputs = 


sizes.DirFeeGQthroughn =- 0 
Sizes.NunSampleTimes = 01 当 at 1east cnc oample time is needeq 
sys = simsizesfsizes); 


xD0 = 





Str = 


ts = [* 


functicn sys=malOutputs (t ,Xu) 


g-9.6; 
mi-1， 

1=0.25; 
aq-2.0， 
a=200;b=150; 
J=473wmx1^27 





I-ut1) 7 


XUd2) 
X2=ut317 


Qr=RxEx2x*Pixrecos (Ex2+Pix 和 hi 





adr=-&awr(F+*2xpih^2*Simf2xPLL) 


后 =X] 一 工 ， 
Qe=x2-Qry 


tolL= (Q--arJT)*aQe-DxI*xe+I*dar+d*QGQr+Imxgxlrcos(tX1) 7 


“414。 





BYyS11)=tol7 


家 数 被 控 对 象 程 序 ，chap10_1plantm。 


fanction [sys,x0,strits]】 = spacemodel (xuyElag) 


swiLch 丰 Lag， 
case 0， 
[sys,x0,sLr,rs1=malszniriaizizeSizesy 
case 1 
SYS_-malDerivatives (tc , Xu) 
Case 了， 
Sys=mdOutputs(t, xu) 
case {2,4,9} 
SYS= [7 
otherwise 
error1['Unhanqled tzag = ,num2scrtf2aGl]) 1 
enG 


funaction [sys,x0,stz,ts]=mdiInirialiizeSizes 





Sizes = Simsizes: 
sjizes.NumcontStautes = 2; 
sizes,NumniscStaces 
Sizes.NumourPurs 
sizes.NumInputs 


sjzes.Dirreedthrongh 





si zcc .NumsampleTimes # at least one seample :ine is needeG 


sys = simsizestsizesli 





x0 = [070]7 





Function sys=mdlDberivat ives{t,x,uy》 &%Time-varying model 


gs=9.87 

ml 

1=0.25; 
Q=2.0; 
T=4/3xmy1721 


七 DLL=G7 


“415 





stfl11-xl2) 7 


syat2J=17TYI-Gxxi2) wx*Gx1rcostxtL)1-toly 


zunction sys-maLou-putstt,xyul 
gsys(11-x(1); 


SYS 2)=XI2) 


作 图 子 程 太 :chapt0_1plotm。 


Close 习 117 


figuretly 
Blol te) 


XIabcltetirelei ilabclt'error 


FiScef2) 7 
2 


"position trackiag'y 


BIOLIE Yi) IE 





XLEbe 1 Limefs 7 


fguret3l 

PIloL IE 97 ID) 

X1aoclfrtirmels)' lylabe2(' specQ tracxirS 1 7 
ftsgareld4)1 

Piorttitol， 1) 





X1abe iimefes Jr72abelf eol 


10.2 ”不 确定 性 单 臂 机 械 手 的 PD+ 前 馈 控 制 


10.2.1 ”不 确定 性 单 臂 机 械 手 的 运动 方程 





考虑 不 精 定 性 单 臂 机械手， 即 粘性 摩 掠 系数 不 准确 ， 且 不 忽略 弹性 摩擦 时 的 情况 。 假 设 
粘性 凑 擦 系数 真 舍 为 4 ， 且 弹性 摩擦 系数 为 5 ， 此 时机 械 髓 运动 方程 为 : 
让 +d6+609+Hmgitcosg = 《10.8) 
粘性 天 掠 系数 的 不 依 定 性 用 误 养 8 去 下， 即 : 
5 -d-d (10.9) 


针对 不 确定 性 对 象 ， 取 8 = 0.8 ，60=02 ， 其 他 参数 与 10.1 节 相 问 ， 仍 采用 式 《〈10.7) 
去 示 的 控制 律 ， 仿 真 结束 如 网 10-6 利 网 10-7 所 未 ， 可 见 ， 由 十 不 确定 性 的 存在 ， 位 置 跟 踪 
误 符 和 速度 跟 足 误 差 均 不 为 志 、 


.416， 





posrtion tracking 








4 
timets) 


图 10-6 了 下 入 位 置 跟 闵 





speed tracking 
局 





0 2 4 人 8 10 
timets) 


图 10-7 ”下 路 速度 踊 踪 
10.2.2 ”仿真 程序 及 分 析 


Simulink 主 程序 ，chap10_2.md， 如 图 10-8 所 未 - 





















































式 rr 时 。 
【br 一 | 上 - 
2 
8 To Wionspace To Wof<pace1 
Mux 上 -| 
基 |durdt Teace2 
Damwatve 
一 
Mux 上 | 人 



































6 1 L 
2 Mux |ehap10_1= cehap10_2plant emiux To WoksPace3 
Sm [人 


anerator SFoncton SFuncthont 




















tl 





ToWenspace4 








赂 148 厅 傅 定 条 件 下 机 械 堪 的 Simoulink 土 得 学 
.417。 





S 菌 数 程序 ， 同 chap10_1s.m。 
S 郴 数 被 控 对 象 种 序 : chap10_2plantm。 


function 1sys,x0,str,ts] =- spacemodelIt, xiuvElag) 








Case 0， 
[sys,x0,Strvts]=mdlInitializeSizcsy 
case 1 
SyYe=malLDerivativestty xyrul 
Case 3， 
Sys=mdjOutputs (xu 7 
case {2,4,3} 
SYSs=[] 
Otherwise 
errorit ['UnhandleQ Flag = "num2strtilaghl])7 


end 


funcLion fsys,x0,sErics]=malinicializeSi2zeB 
SizeSs = Simsizes' 

Sizes.NumCcontStateB = 27 
sizes.NumDiscStates = 0 

sizea.NunoOutputs = 
Sizes-NuiInPutS = 
sizes.DirFeedthrough -~ 


imes -= 1 % at least one sample time is needed 





sizes-NumSample| 
syvs - simsizes1sizes): 
x0 = [0;01; 

StT = [2 


ta = [0 D37 
function sys=mdalDperivativestt,xul 8gTime-varying mode1l 


S=9.87 

=I7 

1=0.25; 
Q=2.0); 

工 =473x*myT^27 


delca0=0.201 
G-2.01 

aeltal-0.85; 

ap=Grgeltali 8Preaiction value 


tol=uy 


- 418 


SySf)=Xt3)7 

syst2)=17ITr(-dpxx(2)-gelLa0xx(-) msgxlxcoatx(1))+tol)1 
function sys=md-Ourputs(L, xyu) 

Sysf1)=x(1) 7 

SYSK2) XI(2) 7 


作 图 程序 同 chap10_1plotm。 
10.3 不 确定 性 单 臂 机 械 手 的 PD 鲁 棒 控 制 


10.3.1 控制 器 设计 


针对 不 确定 性 单 臂 机 械 手 的 运动 方程 式 〈10.8)， 按 “PD+ 前 馈 + 补 偿 ” 的 方法 设计 和 鲁 棒 
控制 器 为 : 
Tf=(d 一 al)e 一 pie+76i+d6i+mglcos6+ 克 (10.10) 
式 寺 5,，Y 为 鲁 棒 补 偿 项 。 
将 式 〈10.10) 带 入 式 〈10.8) 得 ; 


1E+ae+Be= 帮 -6 负 -5o6 -56 一 5oe 《10.11) 
令 w(6,9)=-(5i6 +6o0 1 ， 信 = wiio60- 呈 6-oae ， 则 有 ， 
2E+ae+ae=v+ 如 (10.12) 


令 zT= 攻 可， 则 式 510.12)》 可 表示 为 : 


斌 = hx+BOr+AF) (10.13) 
h，4-| " 工 |，B-| "|. 
-5 -ea 1 


在 不 确定 性 机 械 巷 运动 方 穆 式 《10.8) 中 ,假设 50 和 5 为 未 知 , 但 其 上 界 已 知 ， 即 满足 : 


天 


式 








lgl<a，5lsx， |w6ue sp 人 6) 《10.14) 
式 中 ， 操 ， 太 为 给 定常 数 ，P 为 给 定 的 界 明 数 ， 
_ - 3 6 ， 6 ls | 1 ， 
由 于 A = w(6u60)- 休 2 ccw(6 e+ 下 + 是 本 p(G80+(t 国 + 天 内 














令 F69 ee)= pl6.60+ 了 (ea 轩 + 有 由 ， 则 有 : 
Ar < 访 (10.15) 
10.3.2 ”稳定 性 分 析 
定义 Lyapunoy 冰 数 : 
8Y(O = 了 Pr 


“419 ， 


由 于 44 为 稳定 阵 ， 则 对 于 任意 给 定 的 正定 阵 @， 存 在 正定 解 忆 >0， 满 足以 下 Lyapunovy 
方程: 
4IP+P4=-@ (10.16) 
对 Lyapunoyv 函数 求 导 数 ， 得 : 


允 = 了 2 庆 二 = 王 Ce54i 十 如 IT(V + AF))Pr + 二 xzTP(4z + 吾 (v+AF) 


= 了 CA 十 P4 ) 工 + 了 BTC+ AP) 大 +TBCTAP) 


= 了 Ch4TP +P4a)r+xTPB(V+AF)= -zx +XYTPB(v+AF) 


1 


二 -了 xzTOr +zTPBY 1 ee|erls- 了 xz7gx +zTPBY+|rTPB 食 
人 
2 工 记 万” 

-32P (10.17)》 

7 了 亿 +e 
四 全 

;1 (CrzTPBD 广 ， Top_ _ 上 2 -pr 
TS 导 PB+yem 2F= 2 如 7 “ 


所- zzrgx 二 ye 全 


式 中 ，7y 为 一 个 正 的 常数 ， 只 要 取 y 值 充分 小 ， 便 可 以 实 现 中 <0 。 
针对 不 确定 性 对 象 式 (10.8),， 取 y=9，8=010，5 =02，6o=0.2， 其 他 参数 与 10.1 


节 相 同 ， 采 用 控制 律 式 〈10.10 )， 了 -| 站 则 求解 Lyapunoy 方程 式 (10.16) 得 








4.875 0.2 
0.2 0.035 


跟踪 误差 利 速度 跟踪 误 美 均 趋 近 于 零 。 


|. 仿真 结果 如 图 10.9 一 网 10-13 所 示 。 可见， 由 士 采用 了 鲁 棒 控 制 ， 位 轩 


0.1 


-0.1 





.0.2 一 -一 一 ， 
0 


济 10-9 ”位 园 根 踪 诬 差 


“420， 


position tracking 


taol 
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图 10-10 止 弦 位 置 跟 踪 
1.51 
1 
虽 0.5 
呈 
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遇 -0.5 
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time(s) 
图 10-11 十 蓄 速 度 蹊 踪 
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2 
2 上 
-4 
0 20 4 局 0 100 


timets) 


图 10-12 ”控制 器 输出 
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10.3.3 仿真 程序 及 分 析 


Simulink 主 程序 : chap10_3.mdl， 如 疼 10-13 所 示 。 











Cloek To Workspace 


To Workspace2 
9na 


Generator 


To Workspace3 
To Workspace4 





图 10-13 ”不 确定 性 时 机 械 铝 的 Simulink 主 程 序 
S 末 数 控制 子 程序 ，chap10_3s.m。 


function Tsys,x0v,stritsl - spaccmoce2 (kt,xvruyflag) 


Swiktch f1aS， 


casec 0 





[sys,xo,scrvts]-=mdalTnitial:zesizesi 





case 3， 

sys=madlOurpPuts tt xiu)i 
Case 12，4，93 

SYS= 1 


Drzpner 





erxror(['Unhanadleqd flag = ,num2stIT (+1agh]) 


era 


sanction [sys,x0,stz,Ls]=nmclInit:ali7zcSizeS 
sizes = Simsizes' 


sizes .NamD scStates = 0 





sizes.SXumousputs = 
sizes.NumLlnpuLs = 
sizes.DirFecqathrecghn = 
Sizes.NumSarpleTimes = 


sys =- simsizes1sizes)7 





functicn SYSs=md2oOoutputs (ft ,xu)》 
G=9.81 

mi= 工 > 

了 =0.25: 

Q=2.0， 

I=47/3*mx*1I^27 


=2(1)7 
吕 六 = 妆 六 +FP2+PiFCOS [FEEFY2YDPIwL) 7 
gdr=-aar (FFw2+BPi) ZSInIEEFZxPIyt) 7 





全 =X] 一 工 : 


Ge=x2-Gr: 


=207P=257 





a=10 17-b -al 
Br=[05137 





GelEa0=0.27 


Qelta1=D -27 


w=-taqeltal*Qr+QeltaoxrhyxIi 
&df=w-delralyI*de-GQeltaD7I*e7 





Ton=abs(w)+0.107 


Toual=rou+1/yIx (apsitGQe)+absfe)) 7 
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xe=[eiqe] 1; 
V=-xe'xBrBxroul^21(ans(xe'*PrB)*roul+gamaxexp( betaxt)) 1 


$v=07 


QI1L=QeltalL+a7 


上 te]= (9-ax 工 )*Qe-PxIYe+IYddr+QxQr+ImYG*1LYCOSTKX1L) +IAVT7 
BySsf2)=rcl7 


3 函 娄 被 控 对 象 -程序 : chap10_3plantm。 


sunction [sys,x0,Scr,LS| = Spacemodqel (cxXrayf>agy) 


Swicch 王 1agy 


Cagse 0， 


,zx0,str,bs]=malIniLjializeceizesi 





SYS=ImQlpertwariVes 人, XU) 


diOUEPuES TEXT 





Case i2,4，93 
Sys=[]7 
otherwdse 
errorf['UnnanaQlea flag = ,Tam23tX (ETaS) 1 ) 


ep 对 


Eunction [sys,x0,str,LS1=mdlIPiLiali2ZeSizes 

sizes - Simsizes7 

sizes.NumconcStates = 2; 

sizes,NumDiscSktates = 0; 

sizcs.Numoucputs = 2; 

sizes-NumInpuLs = 1] 

sizes.D2zPeedathrough = 0; 
工 7 


sxes.NumSampzeTimes = 


SYSs = simeizesltsizes) 7 
x0 -5070]7 
Str > [] 


zs = LI0 D7 


Euanction sys=malDerivazivesft,x,Duj ， sTime-varying model 


9.87 








-2.01 


1 43xmee2i 


aclta0=0.21 





delkal=0.2: 


Q1=deltal+Gi 





SYST1]-= 共 (1 


SySI21=- 7 Txttol-Q-*xf(2)-QelIta0*X( ) -mrgyrlxcosl(X(t))) 7 
fusckEion SYS=mGLIOUtputs If,XU) 


SYySsI1)-XK(1LI7 
SYS12)=XI2)7 


作 图 程序 ，chap10_3plotm。 


close al]1 


figure(2) 7 
Blot 人 err 


xlabelt'kimels) yy1abelf'ercozr ) 1 


figure(2) 
DPlot (YL 1) vtyt2)，D 1 


xlabelftrctimefts)' yylabell'position tracking' 1 


于 iSRYet3) 7 
了 LIot (kgyt: LT kiGyt: 2 pb 7 


X1labelil'kimefsl' :yl1abel(' spPeed racXxing' ) 


figurel4) 7 
Bob (ty bol zi 


XIabelizime(sy')yylabel('tol' 


10.4 基于 PD 的 彤 关节 机 器 人 控制 


针对 N 关节 的 机 器 人 控制 ， 陈 启 军 教授 等 提出 了 某 于 PP 的 3 种 常用 机 器 人 轨迹 跟踪 的 
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控制 算法 ， 并 证 明了 算法 的 稳定 性 所 。 该 控制 算法 用 其 稳定 性 分 析 具 有 一 定 代表 性 。 下 面 分 
别 介绍 这 三 种 控制 算法 ， 并 通过 仿真 进行 验证 。 


10.4.1 N 关 节 机 器 人 运动 方程 


考虑 具有 疡 个 旋转 关节 的 刚性 机 器 人 ， 其 功力 学 模型 为 ， 
af(9)6+C09.9)D+TG(O)=T 《10.18) 
趟 中 ，6e Re 为 关节 用 位移 量 ，M(@)e Re" 为 惯性 年 阵 ，C 介 ,6js 表示 离心 力 和 哥 氏 力 项 ， 
Ge)js Re 为 重力 项 ，re 及 为 控制 力矩 。 











10.4.2 PD 控制 


对 式 〈10.18) 所 示 的 系统 ， 考 虑 如 下 入 制 律 , 
= 一 Ke 一 Ke 《10.19) 





e=8-6b，eER 
e=6- 负 ，eER 
后 =diag 人 io 和 二 >0 
大, =diag 人 大， … 并， >0 
如 昌 期 望 跟踪 的 轨迹 速度 负 和 加 速度 负 有 界 ， 则 式 〔10.19) 可 保证 e 和 # 指 数 收敛 到 半 
径 ” (0i=12 ) 的 封闭 球 ， 增 大 名 和 & 可 使 球 半 径 任意 小 。 


10.4.3 PD 控制 + 前 馈 控 制 
对 式 〈10.18) 所 示 的 系统 ， 考 虑 如 下 控制 律 : 


= 一 Ke 一 Ke+M(B) 记 +C(9.6)6.+G(9) (10.20) 
如 果 期 望 跟踪 的 轨迹 速度 6 和 加 速度 负 有 界 , 则 式 (10.20) 可 保证 和 * 指 数 收敛 到 0。 


10.4.4 PD 控制 + 修正 前 馈 控 制 
对 式 〈10.18) 所 示 的 系统 ， 考 虑 如 下 控制 律 : 
了 = 一 Ke 一 Ke+M(@) 记 +C(Bi60)6 +G(B) (10.21) 
如 果 期 望 跟踪 的 轨迹 速度 6 和 加 速度 负 有 兴 ， 则 式 〈10.21) 可 保证 和 # 指 数 收敛 到 半 
径 # (Ci=12 ) 的 封闭 球 ， 增 大 种 和 及 可 使 球 半径 任意 小 


10.4.5 ”仿真 程序 及 分 析 


仿真 实例 
设 机 器 人 的 动力 学 模型 为 : 
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已 Dacos8 -6@ 儿 和 
| D 1 
信 sin 人 ) -入 | |， 


6sin(6,) 9 所 
| 全 sin(e -6) 上 
一 DG2sin(g, -6) 
式 中 ，DPii= 2.462kg,m: ，D =0.362kg.m? ， 


在 仿真 过 程 中 ， 指 令 信 切 选 为 F=2， 控 制 参 
Ka = 210。S=1.2 






站 ,| =0.147kg.m” 


数 为 ， 局 ;= 3000，k = 2000，ks = 230、 
3 分 别 对 应 三 种 控制 律 ， 采 用 PD 控制 + 修正 前 馈 控制 式 (10.21)， 进 行 仿真 
(CS=3)， 仿 真 结果 如 图 10-14 一 图 10-17 所 未 。 












timets) 


图 10-14 关 首 ] 的 位 置 跟踪 





drtx(2 











2 
timet(s) 


图 10-15 ”关节 1 的 速度 跟踪 
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timeks) 


图 10-16 关节 2 的 位 置 跟踪 














1 2 3 4 5 
timets) 


图 10-17 关节 2 的 速度 跟踪 
仿真 程序 的 控制 主 程序 : chap10_4.m。 


$%PD Concrol for Robotic Manipulator (2003704715) 





Ctear all: 
ClLose 已] 


global 了 


XO=[O.0,0, 0]1 


ts=0-0017 

Tz5.87 
TimeSer=[D:fs:T]， 
Para=[] 


[ty1=oqe45(0'chapl10_4eq' ,TimeSer,x0，[]，Par 忆 ) 7 
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Sawirch 下 
case 1 
xi:pi765Tr2=pi765 
arl1=07dr2=01 
case 2 
zl=sinl3wc)5r2-Cost3yb) 1 
arl-3wcos(3xtjidr2--3yrsimt3xt 1) 


Case 3 


Ti=signtsint3rfr))7r3=Sigmsim 3) 》 了 


Qrl=07dr2=07 


en 


fazgurell) 7 


Plot(ET1L， TY 1T) 了 P 7 


X1abel (timetsy )》 YL1abpelf 人 Il1,X 人 IT 7 


fieurel2) 1 


Dlot(t,GQr1， Et 2 D 7 


xlLaipelft timetS5y 3yl1abel('GQr1,xt2) 1) 


于 Sure 了) 
Re (LT2，T LEOYL3 7 3) Db7) 


X1abeltit'bimetsl') yl1abel('r3,X(3) 1) 


于 iguTet4) 
Plet 人 Gar2 EC 


xiabeli'cimefs)')yylapelt'ar2,xf2 


控制 子 程序 ， chap10_4eq.m。 


function Gx=PlantModel (5 ,xyf1agvBDar} 


gcbal 上 


QGx=zeroe (4，1) 


开 





Switch 已 
CaSG 工 
1=pi7y6;r2=pi763 
arl=0iar2=0; 
adrl=0;ddr2=07 
case 2 
zl=sin(3*c] ;r2=cos(3xt) 1 


3Ywsimt3xkb) 7 





Gr1=3wcosf3x*t) 9r2 





adrl=-3*3*8intf3t) Gdr2=-3*3xCOoSs1{f3xt) 7 


) 
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Case 3 
r1=sigmfsinit3x*t))7r2<signisint3xrc) 7 
SGrl=0:Qr2=07 
Gar1=0;ddqr2 

ETIQ 

Qr=farliGr217 

adqr=taer1ljaqr2]7 





el=Xf1) -17 
Qel=xf{2)-Qrl1; 
e2=x(3) TI21 
Ge2=x(4)-Qr27 


kpl=30007;kvL=2301 
kp2=2000;:kv2=210: 


D11=2-4621 
D22=0.3621 
D12=0.147: 
D21=0.1471 


M=[D11 D12x*ces(X(1)-X(3)) 

了 D21*cos(xt1) -xf3)) D22]7 
G=LlD123*X(4)22w8Sin( 区 1) -XI3)) 7 

-12*XT3) 2xSinfXI1L》 一 XI3》 了 
C=I-xl4)xsinfxt3)) -(xf2)+xlq4))ssintxt3)) 7 

XI2)*sinfxf3)) 0]7 


S=31 
Switch 3 
C 冯 S 台 二 
UL=-kpL*el-kVLI*Qel7 
2=-kp2x*e2-kv2xQe3 
Cagse 2 
UL=-kpl*el-kvlraet+Mf1 ,rr*xGoar+rCct1l 3: )*ar+Gt1) 
UD2=-KP2re2-kv2xGe2+KI2，:)*Qadr+Cl2 :xdar+G(21 1 
Case 3 了 
HMq=[P11 D12*costr1-I2) 7 
D21*cos(r1-r2) D2217 
Gd=[TDP12xQGrL2xsintrT1-r2) 7 
-D12xdQr2^2xsin(rL-z213 1 
CQG=[-Qr2xrsin(r2) -(Qrl+drZ)j*gsintr2) 7 
430。 


QTr]*eimtr2 号] 
8IL=-kpl*el-k7i*rae +yct2 :lxadrrcatl :rdrrod(1) 
UPZ=-kp2re2-kV2*Ge2+yMql2 :raarcGt2 :1*qxr+Gqt2)7 
endl 


1o1I= [upPnal2 
-invtK)*ttol-cr[x(2)7xf4)]-Gy: 


XI(L)=X(2) 
xft2)=Q() 
Qt3)=Xtq 1 
Qxt4)=Q12)7 


10.5 机 器 人 的 鲁 棒 自 适应 PD 控制 


具有 强 神 合 性 和 非 线 性 的 机 点 人 系统 而 言 ， 线 性 PD 控制 是 最 为 简单 号 行 之 有 效 的 控制 
方法 ， 在 工 灶 机 器 人 中 得 到 了 广泛 的 应 用 ， 但 实践 表明 ， 线 性 PD 控制 往往 使 驱动 机 构 有 很 
大 的 初始 输出 ， 向 驱动 机 构 〈 通 常 是 电机 不 叫 能 提供 过 人 的 初始 力矩 ， 且 机 械 臂 本 身 所 承 
受 的 最 大 力矩 也 是 有 限 的 , 这 将 使 通过 增 人 PD 控制 系数 来 进一步 提高 系统 的 性 能 受到 限制 。 
鉴于 此 ， 很 多 非 线性 PD 控制 方法 被 提出 ， 但 常规 的 非 线性 PD 控制 器 肥 有 单纯 的 PD 项 , 要 
求 比例 和 微分 项 的 系数 仍 较 大 ， 存 在 输出 力 先 较 大 的 问题 。 

焦 晓 红 等 挑 出 了 -种 自 适 应 兽 棒 PD 控制 策略 ， 避 免 了 礼 始 输出 力矩 过 人 的 观 端 '1. 
控制 器 由 非 线性 PD 反馈 和 补偿 控制 两 部 分 构成 ， 入 不 全 学 全 国 四 乱 了 和 
的 自 适 应 控制 器 进行 补偿 ， 并 针对 机 器 人 有 办 扰动 的 上 确 界 是 桔 已 知 设计 了 两 种 不 同 的 扰动 
补偿 法 。 该 控制 策略 的 优点 在 于 当初 苔 误 莽 较 大 时 ，PD 反馈 起 主要 作用 ， 通 过 非 线性 PD 控 
制 ， 避 免 了 过 人 初始 力矩 输出 ， 当 误 美 较 小 时 ， 白 适应 控制 器 起 者 主要 的 作用 ， 从 而 保证 系 
统 上 共有 恨 好 的 动态 性 能 





10.5.1 机 器 人 动力 学 模型 及 其 结构 特性 


考虑 一 个 如 关节 的 机 器 人 ， 其 动态 性 能 可 以 由 以 下 二 阶 非 线性 微分 方程 描述 : 
af(9 认 +C(6,.6])6+G(9)+D(6)+w=f (10.22) 
式 中 ，B6 E 民 " 为 关 闻 角 位 移 昌 ，M(6)eE Re 为 机 器 人 的 民 性 算 阵 ，C(8,6)e 尺 表示 离心 力 
和 哥 氏 力 ，G(9)e R" 为 重力 项 ，PD(6je R" 表示 粘性 摩擦 力 和 干 摩 探访 ，re 玉 为 控制 力矩 ， 
OoE 玉 "为 各 种 误 辩 和 扰动 。 
机 器 人 系统 的 动力 学 特性 如 下 ; 
特性 1，M(8)- 2C(8.6) 是 一 个 斜 对 称 徐 阵 。 
特性 2， 惯 性 矩阵 于 () 是 对 称 正 定 舞 阵 ， 存 在 正 数 mm， 辐 满足 如 下 不 等 式 
机 本 记 <r7ag(e)z so 510.23) 
特性 3: 存在 -个 依赖 于 机 械 于 参数 的 参数 向 基 ， 使 得 MH(8) ，C(8.6) ，G(9) ，D(6) 满 
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足 线性 关系 ， 
(BA+C(9.6)p+G(9)+ DB)= 苗 (9.6.p.9)P (10.24) 
式 中 ， 锣 (8.6.8.p)e Re 为 已 知 关 节 变 基 困 数 的 回归 敌阵 ， 它 是 机 器 人 广义 于 标 及 其 各 阶 导 
数 的 已 拓 函数 矩阵 ， 亚 e 及 是 插 述 机 器 人 质 号 特性 的 未 知 定常 参数 向 量 。 
假设 1，6ue 8 为 期 望 的 关节 前 位 移 ， 负 的 : 阶 导 数 和 一 阶 导 数 存在 。 
假设 2: 误 养 和 扰动 妇 的 冰 数 满 怎 : 
可 [se + aa 必 +2a 同 《10.25) 
式 中 ， 胃 ，d ， 力 分 别 为 正常 数 ，< =8-6j.e=6 一 6 分 别 为 跟 陈 误 辩 和 跟踪 误差 导数 。 














10.5.2 ”控制 器 的 设计 


分 别 引 入 变量 》 和 8 ， 并 令 : 





?=E+ye (10.26) 
外 = 负 一 ye (10.27)》 
式 中 ， 常 数 y> 0 ， 则 可 推出 : 
>Y=6- 人 6 (10.28) 
将 式 〈10.24)、 式 〈10.26) 一 起 〈10.28) 代入 式 〈10.22) 中 ， 可 短 : 
4(9) 了 +C(B.6)y=T 工 -入 (9.6.6..6) 已 -四 《10.29) 


1. 扰动 信号 的 上 确 界 已 知 时 控制 器 的 设计 


对 于 式 〈10.22) 所 示 的 机 器 人 系统 ， 在 误 痊 扰动 信 妇 的 上 确 界 已 知 时 ， 采 用 控制 锋 
式 《10.30) 和 式 〈10.317?， 可 保证 系统 全 局 渐进 稳定 . 


二 天,6+ 甸 (8.6.6.6)E+u 《10.30) 
2 了 Gd 反 +e 人 sen0s) (10.31) 
忆 的 参数 估计 律 取 
疡 =-F61(6.6.6.6)7 (10.32)7 
其 中 ， 


:Bu 人 e)， 开 ,= 居民 BE) 
天 一 diag 人 no Ra 一 diagloon sk) 
Ka = diag 人 Co 





。 1 1 1 ， 1 1 1 
Or 吉本 二 二 辣 | Or 下 本 下 梧 一下 辣 ] 
臣 由 Ke， ai ， 天 有 人 =12….m) 均 大 于 零 ， 卫 为 正定 对 称 阵 。 
在 参考 文献 [42] 研 究 成 果 的 基础 上 ， 这 里 给 出 稳定 性 证 明 的 详细 推导 过 程 ， 
稳定 性 证 明 : 
令 声 = 五 已， 定义 ELyapunov 函数 为 : 
Y -Jo +er 代 + 交 )e+rPP) 





0 
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和 号 虑 M 为 对 称 正定 矩阵 ， 则 有 : 
人 apj -FMNBj+yrMN+ jy=273+ Gy 
回 理 ， 必 得 ; 
人 re sej -zer +)e 
全 rr- ->Prr -二 
则 有 :; 
史 =M 介 太 + 了 用人 Ter(K Ye+ 下 在 
由 式 〈10.29》、 式 〈10.30) 得 : 
TMGD=E-o6.6.6.6)jP-o-ce.6h] 
-mLKe-Ke+rG6.6.6.6Jjp+ue-e6.6.6.6)JP-o-ce.6b] 
=yrEKe-Ke+e6.6.6.6)jP+u-o-orce6)> 


了 各 和 天 的 定义 行 : 
天 十 佐 。= 本 天 Bu(e) 二 (大 一 天 2 奋 (E 


eT 攻 全)je=erkoe-erEoBe)+ 估 :BEG]jereryRe 





则 人 有: 
-LAe-Kere 人 .66.6 和 rw-ol-yrce.6b+ GDb+ 
Ke -er 人 人 + 人 RE]jE+emR ErPIT -下 
由 机 器 人 特性 1 可 知 : 
四 . 1 3 ， 1 1 - 
一 C6@.6p+57 人 @J= 了 ? re)-2c6@.6 力 =o 


则 
玫 = 亲 人 Ke 及 6jHeKLeAeTENe-e (KaoBej+IKB GE))e+ 
7 加 6.6.6.6 Je-ojlr PT 
由 己 知 得 : 
rer 
则 有 : 


TCRKe-KeE)= -ETIKe-eIKE-YeIKoe 一 Ye ve 
将 上 式 带 入 上 关 中， 得 : 
= -6IK.E-YeTKie 一 6 人 osBiGe)+yKoaGE)je +3T(e 一 oo)+ 7 人 .6.6 志 庆 +PrT -证 
考虑 色 yr 田 .6.6.6 ) 巨 = 五 1B7(6.6.6. 从 ) 、 巨 -= 户 有 民 式 (1032) 得 ; 
6.6.6 和 这 +PrF- 瑟 = PerB66.6y+rPT -Pr 人 .6.6.6b+r- 古 








则 有 有 ; 
= 一 Ye Koe 一 ETK6 -er e)+yKoBGje+rort-o) 


2 
其 中 
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erEse -yo es+koBG@ 
Er 
上 和 aa 
Ku o + o + 地 
Be)= 二 
an L An 
oo + 名 | oo 十 gu 
ka 
it 
天 +KroB te)= “ 人 
oa 
和 oo + 人 | 
el 
工 ee|_ 总 玉 2 2 
TerRie=T7 攻 er : -7 mt 
en 
间 填 : 
ETK LE= 祥 | 天 + ea 6 
T=1 有 十 图 
ca 人 -KaB GE= 虽 二 + 人 
玫 的 弛 < 巨 + 思 | 
则 有 有: 
国 和 2 1] 总 Ka | Ra 
=- -了 | | - 6 凸 站- 国 
下 让 [人 ] 让 5 ] 站 o%+ 全 | 三 了 + | 
旧 寺 ee ss 人 + 全 )， 则 有 ， 
吕 || _ 各 2， Ka | | 二 工 辣 || 2， Ya | 工人 bp， yoai 
计 攻 5 若 洒 je 上 5 及 + 加 上 坟 w+ 所 “+ 奖 上 
， 有 2 | 工 各 2 了 下 和 
vs- 让 | 引 二 8 + 恒 | 加 
几 天 了 大 2 了 并 2 TO ) 
一 ， 一 |- 二 二 包 
让 吉林 7 “8+ 合 和 
当 22y > 时 ， 有 : 
ha 1 -0 
7z+ 2o+ 四 | 
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马 2 工 入 
已 + 加 -有 癌 澡 
此 时 ， 
。 本 
VY 科 - 革 人 - 二 j 上 了 雯 访 ] 上 -o) 
一 EL 世 到 2 ] 机 攻 -请 ] -g) 
由 于 
Je- 写 [人 包 +@ 罗 >deljkenco- 训 [人 ee 有 过 -hl 


NM 
Rn |- 于 





则 有 : 
了 sl=o 
; e 工大 上 2 ;> 
9 下 党 | ] 
只 要 如 ，&r ，w% ， 房 的 取 值 满足 : 
2 
翌 >0 (10.33) 
天 
Ku 下 >0 (10.34) 
2 
就 可 以 得 到 : 
玫 <0 


则 由 所 定义 的 Lyapunov 琢 数 容易 得 到 lime =0，lime =0， 控 制 器 全 局 渐进 稳定 。 





2. 扰动 信号 的 上 确 界 未 知 时 控制 器 的 设计 


当 误 美 拓 动 信号 外 的 上 确 界 为 本 知 时 ， 设 计 控 制 器 为 : 
了 = 一 下 2 一 天 ,6+ 甸 罗 .5.6 人 ja+u (10.35) 


= 人) 《10.36) 


= 一 了》 
才 pl+e 

4=xj 所 ，2O)=o 《10.37) 

6E=-7e，c)=0 (10.38》 
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式 中 ， 枉 ， 玉 的 取信 同 式 〈10.30)， 并 保证 满足 式 〈10.33) 和 式 〈10.34)， 忆 的 估计 舍 通 过 
式 51032) 求 得 , d = 直 + 几 二 四 了 = 有， 了 =max 人 ll 人)， 为 @ 的 估计 值 ，7， 
7y2 均 为 任意 的 正常 数 。 

对 式 !10.22) 表示 的 机 器 人 系统 , 并 且 误 差 扰 动 信号 的 上 俩 界 木 知 时 , 采用 式 (10.35) 一 
式 〈10.38) 表示 的 控制 律 可 保证 系统 全 局 渐进 稳定 ， 
证 明 ; 

定义 Lyapunovy 函数 : 

了 -orwGehy +eT 代 。 + 惰 。 Je ET 下 re3) 
由 扰动 信号 上 确 界 已 知 时 拧 制 器 分 折 的 推导 可 得 : 
区 syTC aoH 
将 控制 律 式 10.35) 一 式 〈10.38) 带 入 上 式 得 : 


玫 冬 yyro+yr +ya eeE - 志 码 二 -JoO+7TGd 一 e2 





戈 3 
由 于 
757= 人 站 
到 中居 | 
四 <o +elel+eielse7 
= 志 =-xr 风 
和 其中 -res 的 全 pas 

和 作 人 信用 你 je 由 ia- 全 -人 
=- + 旭 jl 一 了 下 pi+e 
” 邢 Fe 


由 个 的 定义 司 知 :，Q > 0 。 则 和 有 ; 
玉 <0 


10.5.3 ”仿真 程序 及 分 析 
仿真 实例 


选 二 关节 机 器 人 系统 (不 考虑 摩 扩 力 )， 其 动力 学 模型 为 : 
MG)6+cC6.6)6+G)+w=r 


MO)- 『 +g+2ycos@) 0+ocos 人 ] 
a+gcos(,) 和 
ci-[-9Gsng) -ae 人 +6jaine) 
d6sin(e,) 0 
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1Sgcos6 +8 了 SR8cosl(B +8;) 
|8TSs8cos(B, +B) 





式 中 ，Vy=13.33，f =8.98，9: =8.15，8 = 9.8 ， 吝 产 扰 动 、 位 置 指令 和 系统 的 初始 状 
态 分 别 为 
ii = 路 =6 
四 = 灰 + 册 el+del 
|6u =costr) 


16 =sin(rur) 


和 ] [06 
中 03 
已 | 0 
四 | [05 





| 参数 取 
K ,=diagf18W190)，Ks =diag(150150) 
天 ,=diag(l80180) ， 大 = diag(150.150) 
ai = 瓦 =1 (=12)，y=15 
器 和 被 控 对 象 的 设计 。 猕 扰动 上 确 界 已 知 和 未 知 两 种 情况 进行 仿 









设 拓 动 的 上 确 界 为 己 知 , 


8 用 控制 律 ( 式 【1030) 和 式 【10.31)) 进行 仿真 ， 仿 真 结 果 如 
图 10-18 一 疼 10-21 所 于 
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属 10-20 





关节 上 的 挤 制 输入 











仿真 程序 的 控制 主 程序 ，chap10_5.mdl， 如 网 10-22 所 示 。 


















































Sine Wave [一 关 | 
一 一 一 
天 一 其 | Mux 上 -加 | chap10.5s chap10_5plant Damux 
SS SFunetion SFPunction1 
Sine Wave1 












































加] 
Soopad 
Dearnux 
"加 
Scopa5 
图 19-22 Simulink 主 程序 
3 函数 子 程序 :chap10_5s.m。 
function [sys,x0,strits] = spacemodel (t,x,u,flag) 


Switch flag， 
Case 0， 
Tsys,x0, str,ts] =melTnitialiizesizesy 
case 3， 
SYS=mdLIOutputs (xu 1 
Case {2, 人,9} 
SYS=[]17 
Otherwise 
error{f['Unhanaled flag = ',num2str(flag)])7 


erdQ 


function [sys,x0,stritSs]=mdaInitializeSizes 
sizes = Simsi2Zes7y 

sizes.NumOutpurs = 23; 
Si2zes.NumInputS = 日 
sizes.DirFeedthrough = 





Sizes.NumSamp]eTimes = 


sys = simsizestsizes) 7 


x0 = 1 
str = 站 ? 
ts = [0 0)7 





Seopa1 








Soope 
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function sys=mdloutputs(t, xu) 
R1L=ut1) 7 

Qr1l=-pirsin(Diwxt) 7 
ddr]1=-pi^2wcos(Pixt) 7 

R2=u(2) 7 

GTr23=Piwcos(Ppixc) 7 


dar2=-pi^2*Ssin(Pixt): 


Xi{tl)=ul3) 7 
Xft2)=ut4)7 
Xf{3)=u(5) 
X{t4)}=ut6) 7 


号 1=X1TL)-RIL7 
e2=XI(3)-R27 
Gel=xt2)-Grl1r 
Ge2=X(4) -Gr27 


v=13.335 
q1=8.9 
G2-=8.75; 
g=9.8; 





M= [v+ql+2*q2*Ccos (x(3)) G1L+G2xcos(x(t3)) 7 
q1+g2wcos(x(3)) al]7 

C=[-q2*x(4jxsintx(3)) -q2*(x(2)+xt4) )wsintfX(3) 1 
G2*xf2)xwsin(Xt3)) 0]: 

G=[35*gGrcos{txt1))+8.75xgGwCOS(X{1)+X(3)) 7 
吕 .75Y*SwCcos(X(L)+X(37)]7 

Ql=23;d2=3;1Q93=61 


gama-1.5; 
yl=ael+rgamarel; 


Yy2=de2+gamaxe21; 


ul=-(dal+dq2xnorm([el,e2j)+d3xnormt [del,Ge2]))*Ssign(y1) 7 
u2=-(dl+d2xnorm([el,e2])+d3vwnormtfdel,Ge2]))*signfy2): 


Gr=[darlyar21-gamarfelie2]; 
aar=[darlyddr2]-gamax[dael;Qe2]7 
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FKp1=[180,0;0,190]， 
Kp2=[150,0;0,15017 
KXv1=[180.0;0,180] 7 
KRKv2=[150,07:0,，150] 


alfal=1ralfta2=17 
Detal=1;beta2=17 


ty=M*qaqr+Crar+G' 

toltl)j=-(KP1(1,1)+Kp21,1)7(alfal+abstel)])*el-(Kvl(1,1)+KV211,1)7(betal+ 
abs (qel) ))*ael+iy(1l)+ul; 

telt2)1=-{Kp1{2,21+KP212,2)71alfa2+absfe2)))*e2-(Kvl(2,2)+KVv2(2，2)7(beta2+ 
abs (de2)))*de2+fy (2)+u27 


sys11)=tol(1) 
syst2)=tol(2) 


被 控 对 象 子 程序 ，chap10_5plantm。 
8%S-function for continuous state equation 


function [sys, xD0,str,ts]l=s_functiontt ,xuyflag) 


Switch ELa 司 ， 
争 Initial 守 zation 
case 0 
[sys,x0,str,ts]=mdlInitializeSizeSsy 
Case 1， 
SYS=mad1Derivatives(ty xu)7 
SOutputs 
case 3， 
sys=mdloutputstt,xyu) 
$Unhanq1eqd 1ags 
case {2，4，9 } 
sys = []; 
8UnexpecLed flags 
otherwise 
errort['UnhandleQ flag = “num2strtflag)])7 
endq 


本 mnG1 工 立志 TSiZe 吕 
function [sys,Xx0,strits]=mdalInitializeSizes 
SizeSs = Simsizes， 


sizes.NumContStates 





Sizes -NumDiscStates 
443 


sizes.Numoutputs = 


sizes.NurmInputs = 
sizes-DizFeedthrougn 


sizes.NumSampleTimes 


SYSs=Simsizes(8ize&) 
X0=[0.6;0.310.5;0.5] 





function SYSs=mdalDerivatives (tt ,Xu) 


R1=cos (Pi*t) 
Grti=-pis*sinfPiwt) 7 
qdr1=-pi^2*cos(Pist) 7 








R2=sintpiwt); 
dr2-pivcos (piyt)y 
ddr2=-pi^2xsintpiwt)y 





人 1=X(tL)-RIT7 
e2=X(3) -有 27 
del=x(2) -dr17 
aqe2=x(4) -dr21 


v=13.337 
ql=8.98; 
aq2=8.75; 
g9=9.87 


M= [v+G1+2*q2wcos(x{3)) SGL+G2x*costX(3)) 


GTL+Q2wcCos{X(3)) 9Q1]7 


C=[-q2*x(a)*sin(x(3)) 
SG2*X(2)wSintx(3)) 


-QG2* (X(2)+X(d4) )>Bintfx(37)7 
0]7 


G=[15*gwcos(Xx(1))+8.75*gwCos(X(I)+X(3)》) 了 
8.75*GxCos(XtL)+X(3))]7 


dl. G2=3 





7Q3=67 





w=[al+d2x*normtf[el,e2]1)+d3*normt [Gel,de2])]7 


toltl)=ull)7 
tol 2)=at2)1 


S=invy(MJ w(tol' -Cr[x(2)5X(4)]-G-w) 


SYS(1)=X{t2)7 
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仿真 方 ; 
设 扰动 的 上 确 界 为 未 知 ， 用 控制 律 〈 式 〈10.35 
则 律 《〈 式 S 式 


疼 10-23 一 图 10.27 所 也 
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疼 10.25 


财 10.26 


拓 靖 





1 的 控制 给 入 





关节 2 的 控制 输入 
































































































































































































































程序 ，chap10_6.mdl， 如 图 10-28 所 示 。 
二 | 基 | 
[ 拓 | 
Spal 
Sine Wave 
并 本 上 六 业 |wux 三 Te chap1o_5plant pemux 
[一 各 jux Ha chap10.5= 上 上 基 |Demux | 各 | 一 
ET 
[3 SFunctiom 
| 
Sine Wave1 | 匡 
| | 
5 
| 
1 
一 一 | Demaux 
soap 
scope 


图 10-28 Simulink 主 程序 


S 霄 数 了 程序 ，chap10_6s.m。 


function fsysrxD,str,ks] = Spacemodgeltc,X,u,Elag) 


Switch flagh 
case D， 
[sys,xD,str,zsj=mdlInitializeSizeSsy 
Case ]， 
SYS=maG1Derivatives(C Xu 了 
case 3， 
SYS=maloutPukS(L, xu) 7 
Case 12, 4 91 
Sys=[]1 
Otherwise 
erTrort ['Unhandled filag = “,num2strftflaS)]) 1; 


enQ 


function [sysv,x0,str,ts]l=mdlInitializeSi2zeSs 

Sizea = Simsizes7 

sizes.NumContSEates = 27 
站 


sizes-NumDiscStates = 
sizes.Numoutputs = 31 
sizes.NumInputs = 6; 


Sizes-DirFeedEhzroush = 0 


"445。 


sizes.NumSampLeTimes = 1; 


SYS = SimsizeSsfSIzes) : 


x0 = [05;0]1: 
Str = []: 
ts = [0D]; 


function sy8=ImalDexrivatives (xu) 
Rl=u(1l)7 

Qrt=-piwsinfpiwt) 7 
ddr1=-pi^2xcos(tPixt) 7， 

R2=ut2)1; 

Gr2=Piwcos (Piwt) 7 


dar2=-pi^2xvsintPixt) 7 


XL=ut(3) 
X2=Qtd4) 7 
X3=utS) 7 
X4=uf6) 7 


所 1=XI-R17 
e2=X3-R21; 
gel=x2-Qr17 
de2=x4-dr27 


f=maxf[l,normt[el,e2]),normf[dael,qe21)]) 7 


gama=1.57 
YL=ael+gamarel: 
YyY2=dQe2+gamar*e21 


Tt=250;r2=2507 


SYS (1)=T1Lx*fxnormt [YL1，Y2]) 7 
SYS12)=-T2*Xt3) 7 


function Sys=mdiOutputs ( 芋 ,xu) 
RL=cos (Pixt) 
drl=-piysin(pivt) 7 
adr1=-pi^ 人 2xcos{pPixt) 
R2=sin(pixt)7 
dr2=piscos (piet) 1 
Gdr2=-pi^2*sin(Piwt) 7 
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X1=u{3)7 
X2=Qfd4) 1 
X3=ut5) 7 
X4=Uf6) 


G1=Xx]-R17 
e2=X3-R21 
Gel=x2-Qr17 
Qe2=x4-Qr27 


V=13.337 
G1=8.987 





M=[v+GI+2x*Gq2rcCos{X3) G1+G2*Cos(X3)》7 
q1+q2xcos (x3) al]; 


C= [-q2*x4*Sintx3) -G2* (X2+X4)*Sin[X3?7 1 
Q2*Xx2*sinkx3) 0]7 


G=[15*gwcos(x1)+8.75vgSwCos(X1+X3) 1 
8 .75*g*COS TXTL+X3) ] 7 


f=maxf[1,Dcrmt[el,e2]) ,norml([ael,dqe2]1)J)， 


Sama=1.57 

y1=dael+gamarel; 

Y2=de2+9amave27 

ul=-(x(1)*f)^2wy1AIXtT)*fwnoxrrmt[y1 y2])+Xf2)^2+0.000000 王 ) 
U2=- (区 (1)*E)A2xy27(XfL*FwnOrmt[Y1 Y2])+X42) 2+0D.00000031)7 


Qr=[darl;qQr2]-gamar [eTIye2]: 
qdr=[ddrlidar2]1-gamar [del;qe2]: 


fy=Mradr+Cwdr+Gr 


Kpl=[180,0;0,190]1 
Kp2=[150.0;0,150]; 
Kvl= [180,0;0,18017 
Kv2=5150,070,150] 7 
447。 


己 Lfal=1;altfa2=17 
betal=1ibeta2= 





tol(1)=-(KDP1(1,1)+KPp211,1)7(alfal+abs(el)))*el-(Kv1I(1,1)+KVv21(1,1)7{(petal+ 
abs (qQel)))*ael+ty(1)+ul7 

tol(2)=-{(KPt(2,2)+KP212,2)7 (alfta2+abs(e2))]jx*e2-(Kv112,2)+KV212,2)7 (beta2+ 
abs (de2)) )*qe2+fy12)+u27 


SYSs(1)=tolt1)7 
Sys(2)=tol(2) 7 
SYSt3)=X(1)7 





被 控 对 象 子 程序 : chap10_5plantm， 与 仿真 方法 一 中 的 被 控 对 象 相同 。 
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第 11 章 PID 实时 控制 的 C++ 
语言 设计 及 应 用 


11.1 M 语言 的 C++ 转化 


仿真 实例 
对 象 采 用 二 阶 传递 函数 为 : 
ca- 523500 
53 +87.35s2? +10470 8 
采样 时 间 为 lms， 被 控 对 象 可 离散 化 为 : 
WE) = -den(2)7( 开 -1)-den(3)y(K-2)-den(4)7(K-3)+ 
num(2)u(K~- +num(3)az( 类 -2)+num(4)a(K -3) 

取 输 入 指令 为 阶 跃 信 号 ， 进 行 位 置 跟踪 的 仿真 。PID 控制 参数 取 台 = 25,. 避 = 

瑟 =0.28 。M 语言 的 仿真 程序 为 chapll_1.m，PID 的 阶 跃 响 应 如 图 11-1 所 示 。 转 化 的 C++ 


语言 (Borland C++) 程序 为 chap11_2.cpp。 











02 imele) 03 0.4 0.5 
图 11-1 BID 的 阶 跃 响应 


M 语言 仿真 程序 : chap11_1m。 
&PID Controller 
clear al1; 


close al17 


rs=0.0017 
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SYs=tft5-235e005,，[1,87-35,1.047e004,0]) 7 
dsys=c2QtsYys,ts， ZI 1; 
fnum,den]=tftdatatdsys，v7) 7 


u_L=0.07u_2=0.07u_3=0.07 
Yy_1=0.07y_2=0.0:y_3=0.07 
x=[D,0,0] 7 


errcr_1=07 


for Kk=13:1:500 
上 ime (K) =K*tS 


YintKk)=17 &%Tracing Step Signal 
kp=0.50;Kki=0.001;Kkd=0.001; 


UK)=kPpx*xf1)+kdqwxf2)+Kixxt3)7 多 PID Controller 


%Limear mode1 
yout (kj=-den(2)*y_1-den(3)*y_2-denf4) xy 3+numl2) wu_1+num(3)*u_2Z+num(4) 3 


erTOF{k)=rin(k)-Yyout(K) 


SReturn of Parameters 


u_3=u_27u_2=u_l1;u_1=uftk) 7 


Y_3-y_2;Yy_2=y_17Y_1L=yout (k) 


Xt1)=errorfk) SCalculating 了 
x{t2)={error (k)-error_1)/tsi scCalculating D 
xf3)=x(3)+error(kywts7 %Calculating 工 


Xi UK)=X(3) 7 


errOT_T=error(k) 
end 
figuref1)7 


PloEtcime,riny'b'vrtime,youL ri 


xlabel(t'timets)')5ylabelfrin yout ) 7 


C++ 语言 仿真 程序 : chap11_2.cpp。 
/7PID Contrel 
#ineclude <math .hy> 


int K7 
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Qouble Yout,u,rin,u_l=0,u_2=0,uU_3=0,Yout_1=0,ycut_2=0,yout_3=07 


Qoub]le Error 1=-0.0,Errcr_2=0.07 





double ts-=0.001; 
double timek, Pi- 





-4159267 
aqQouble kp=0.50,ki=0.001,kda=0.0017 


aqouble ErTor,Perror,IerTor,Derror: 


Yoid maimt) 
foer (K=17k<=50007++》 
革 

七 imek=kx 七 号 


Yin=1: 


//pracEical Position Degree 8ignal ac time 上 
yocut=2.9063xyout_1-2.8227+*yout_2+0.9164xyout_3+0.0853*0.001*u_1+0-3338*0.001 
<D_2+0.0817*0.001xu_37 


Error=yout-~rin7 


ZAPID ControllLeT 


PerIOr=EITOI7 7VGetting 卫 
工 errOor= TIerTOL+ETITOL* 七 B7 7Y7Getting 工 
Derrcr=(Error-ETrOr_1) /ts VZVGetting D 


U=kP*PerrCLI+KixIerror+KkQxPerror 7APID CortrolIeL 
/7VUpdate Parameters 
Error_2=ErITOF 1; 


下 rrOT_1=ErIOCI 


Yout_3=yOuUL_27 





Yeut_2=Yyout_- 
yout-_1=YOUL 7 /Positional Signal at K-1 
D_3=u_27 

T_2=Q-1: 

U_I=ui; 

了 

】 
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11.2 基于 C++ 的 三 轴 飞 行 模拟 转台 伺服 系统 PID 实时 控制 
11.2.1 控制 系统 构成 

三 轴 电 动 飞行 模拟 转台 伺服 系统 由 机 械 台 体 、 电 控 柜 两 部 分 组 成 ， 如 图 11-2 所 示 。 机 
台 体 是 三 辅 仿真 系统 的 土 体 ， 由 基 座 和 三 个 运动 框架 组 成 ， 用 以 安装 试验 负载 ， 模 拟 飞行 


的 三 维 资 态 运动 ， 电 控 柜 由 转台 系统 的 测控 、 显 示 、 了 电子 伺服 装 管 和 控制 计算 机 组 成 ， 上 
构成 转台 的 伺服 控制 系统 ， 实 施 对 转台 的 检测 和 控制 。 


| 
1 
--F---- 才 - ER 
1 MES-S000 
1 | 电 控 相 
-上 - 


关 归 证 























| 下 伺机 
























控 揣 捡 测 机 箱 
NPS -一 一 -一 -一 一 
直流 稿 压 电源 “|| 三 一 北京 航空 

航天 大 学 


























CEZTZXZZTT| 7TTTLZZTZ| 








图 11-2 转台 系统 总 体 结构 图 

内 、 中 、 外 框 三 个 通道 的 数字 何 服 控制 系统 ， 其 原理 结构 完全 相同 ， 如 图 11-3 所 示 。 系 
统 采用 了 微机 控制 下 的 脉冲 调 宽 功 放 装 置 (PWM)， 直 流 力 符 电 机 直接 驱动 转台 框架 的 数字 
伺服 调 速 体制 。 高 灵敏 度 的 直流 测速 机 直接 构成 连续 式 速度 控制 回路 ， 有 利于 系统 刚度 的 提 
高 和 频带 的 拓宽 。 由 高 精度 测 角 元 件 圆 感应 同步 器 和 数字 变换 装置 构成 数字 式 角 位 置 反 馈 回 
路 ， 可 以 满足 系统 的 精度 和 性 能 要 求 。 采 用 工业 控制 机 作为 该 伺服 系统 的 主 控 计算 机 ， 能 
保证 系统 快速 性 能 的 实现 ， 同 时 也 能 很 好 地 完成 系统 控制 律 的 形成 、 回 路 内 部 的 数据 采集 处 
理 、 故 障 诊断 和 监控 管理 ， 使 系统 的 动态 性 能 与 安全 可 靠 性 都 得 到 充分 的 保证 。 


5 可 站 
测速 
机 
[zi 测 角 线路 = 十 瑟 辣 下 要 


图 11-3 内 、 中 、 外 三 通道 数字 何 服 控制 系统 原理 结构 
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11.2.2 


主 种 





中 电流 各 


实时 控制 程序 分 析 


闻 流 程 风 如 网 11-4 所 未 














如 图 11-5 所 示 ， 





刺 始 化 图 形 界 面 





证 


初 妈 化 8253 





了 





初 冯 化 变 基 








消 屏 ， 初 始 化 数 显 胡 





了 





中 入 xas3， 开 始 工作 





了 





设 贺 中断 





一 en 


是 





检查 键 检 响应 












































创建 数据 文件 xyy da 








保存 数据 文件 








委 件 回 堆 ， 恢 复 壕 中 断 











按 任 意 键 进出 








图 11-4 了 种 地 流 各 图 
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英 中 断 


到 和 


计算 remNum JemNum 为 数组 标号 











Counter 为 计数 器 Counter= 2000 








十 
一 了 
Counter 置地 





了 
msSetup 为 实时 时 间 msetup 累 如 -个 采样 信 








二 
计算 控制 指令 














向 DA 对 入 控制 指令 

















TimerCouncec 


为 标 忆 计数 里 








UpdateFlas 置 1 
Timercounter 位 10 


广 一 一 一 


季 中 断 


























到 11-5 中 断 流 程 峡 

1, 程序 中 变量 及 宏 定义 说 明 

4 和 到 分 别 表 示 输 入 正弦 指令 的 凡 值 和 冰 率 。channel 用 来 设 定 控制 对 象 ， 当 channel 一 0 
时 ， 被 控 对 象 为 内 框 ; 当 channel 一 1 时 ， 被 控 对 象 为 中 框 ， 当 channel 一 2 时 ， 被 控 对 象 为 外 
框 。 当 channel 变化 时 ， 改 变 D/A 板 和 D/D 板 的 地 址 ， 从 而 达到 改变 控制 对 象 的 目的 。 

TIMER_BASE 为 8253 定时 器 的 地 址 ，TIMER_RATIO 定义 为 10， 表 示 每 次 画 
个 点 ，TIMER_CYCLE 与 TIMER_RATIO 的 比值 为 采样 周期 。 

TIMER_VALUE 用 来 定义 8253 定时 器 的 初始 计数 值 , 当 N= 1 时 ，8253 定时 器 每 隔 Ims 
发 一 次 信号 ， 也 即 采 样 周 期 为 1Ims;， 当 N 一 10 时 ，8253 定时 器 每 隔 10ms 发 一 次 信号 ， 也 即 
采样 周期 为 10ms. 

Irqnumber 为 中 断 服务 程序 对 应 的 中 断 向 量 叶 。 

DATIA_DIMENTION 才 示 用 于 存 数 的 数组 的 维 数 ，DATA_LENGTH 表示 存 数 数组 的 长 











本 


画 10 
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度 ， 可 调整 它们 改变 存 数 的 数量 。 

T8253_ MODE_0~T8253_MODE_5 用 米 表 示 8253 的 5 种 计数 方式 ， 控 制程 序 中 实际 使 
用 的 是 T8253_MODE_3， 人 在 该 种 方式 下 ，8253 计数 器 产 牛 周期 性 的 方 波 信 号 ， 每 隔 一 个 采 
样 岗 期 发 出 一 个 上 升 沿 信号 给 8259 中 断 计数 器 ， 和 触发 中 断 服务 程序 。 

T8253_CHANNEL_0 一 T8253_CHANNEL_2 用 来 胡 示 8253 计数 器 中 不 同 的 计数 寄存 器 ， 
分 别 与 内 框 、 中 框 和 外 框 对 应 。 

T8253_BIN_MODE 表示 8253 计数 器 的 计数 方法 为 使 用 二 进 制 ，T8253_BCD_MODE 表 
示 8253 计数 器 的 计数 方法 为 使 用 十 进 制 BCD 码 。 

T8253_COUNT_LOCK 表示 8253 计数 器 锁 存 ，T8253_COUNT_LOW 表示 8253 计数 器 
的 写 入 方法 为 邱 入 低 8 位 ，T8253_COUNT_HI 表示 8253 计数 器 的 写 入 方法 为 写 入 高 8 位 ， 
T8253_LOW_FIRST 表示 8253 计数 器 的 邱 入 方法 为 先 写 低 8 位 ， 再 气 高 8 位 。 

EOI 为 8259 中 断 管理 器 的 选 通信 号 。 

KB_C_N_F4~KB_C_A_X 表示 键 些 上 字符 对 应 的 数值 及 其 转化 结果 。 

当 使 用 的 编 详 器 为 C++ 编译 器 时 ， 将 _CPPARGS 定义 为 “用 于 中 断 服务 程序 。 

2. 整体 设计 思路 

采样 时 间 为 Ims， 即 竺 隔 0.001s 执行 一 次 中 断 ， 在 中 斯 中 完成 控制 律 的 计算 、 采 集 实 时 
输出 信号 、 发 出 实时 控制 信号 ， 若 存 数 标志 位 为 ] 时 ， 将 每 次 采样 时 的 输入 信号 和 实时 位 置 
信号 存 入 存 数 数组 ， 得 隔 0.01s 将 画图 标志 位 置 为 1。 
主 程序 由 执行 一 个 循环 ， 循 环 的 跳出 条 件 是 跳出 标志 位 为 1。 在 循环 中 ， 当 画图 标志 位 
被 置 为 上 时， 执行 画图 丽 数 和 键 竹 响应 丽 数 ， 也 即 矢 隔 0.01s 画 一 次 图 ， 检 查 一 次 键盘 响应 。 
当 检 但 到 F5 时 ， 将 存 数 标志 位 喃 为 1， 这样 在 接 下 来 的 中 断 中 可 以 执行 人 存 数 操作 ， 当 检 介 到 
ALTTX 时 ， 将 跳出 标志 倍 置 1， 这 时 将 跳出 循环 。 循 环 由 “让 执行 显示 实时 时 间 的 功能 。 

将 存 数 数组 中 的 数据 存 入 名 为 xyz.dat 的 文件 中 , 其 中 第 一 询 位 输入 指令 信号 ， 第 二 列 位 
输出 信号 。 

3. 子 函 数 说 明 

二 ”及 esetShuxianbiao(》 

实现 数 显 表 的 初始 化 ， 将 内 框 、 中 栖 和 外 框 数 显 衣 全 部 清 零 ， 通 过 负数 显 表 端口 写 入 相 
应 的 信号 实现 。 

和 ReadD_DO0 

采用 DAD 板 实时 位 壮 信 号 的 采集 。 将 数 显 表 产生 的 23 位 传 感 信号 读 入 计算 机 ， 并 转化 
为 相应 的 实际 位 置 值 。 连 续 读 入 两 次 数 显 圾 的 输出 值 ， 当 它们 相等 时 ， 认 为 信号 稳定 。 读 入 
全 号 与 实际 角 位 置 之 间 的 比例 系数 为 0.9， 乘 以 0.9 后 的 信号 单位 为 角 秒 ， 要 再 除 以 3600 转 
化 为 角度 .23 位 传 感 信号 的 第 23 位 是 符号 位 ， 当 其 为 上 时， 表示 该 实际 角 位 置信 号 为 负 值 。 
该 函数 的 返回 值 为 实际 角度 。 

和 Write_DAO 

将 控制 信号 发 送 到 D/A 板 ， 实 贡 控 制 器 的 输出 。 

筷 ”KbGetKey0 和 SetupKeyReactionO 

实现 键盘 管理 ， 键 盘 参 数 在 头 文件 chap1]_3.h 中 设 定 。 判 断 按 键 是 否 足 F5 或 ALT 十 X， 
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如 末 是 F5， 训 将 在 数 标志 位 置 1， 如 果 足 ALT 十 X， 就 将 跳出 标志 位 置 1， 数 据 保 在 由 FS 键 
实现 ， 有 退出 出 ALT+X 键 实 鞠 ， 

鲁 DataSavedRoutineO) 

实现 数据 个 储 功能 ， 接 F5 键 则 保存 数据 ， 保 存 文 件 名 为 xyz.dat， 此 时 存 数 标志 位 是 于 执 
行 在 数 操 作 ， 将 指令 估 号 和 实际 得 出 信号 存 入 -位 数组 ， 帆 数组 长 度 决 定 企 数 多 少 ， 存 满 为 
引 。 

鲁 ControlO) 

调用 Readp_DO 读 入 实时 位 置 数据 ， 根 据 指令 信和 续 
制 指 令 。 在 该 函数 中 可 以 实现 各 种 控制 分 法 。 

鲁 DynamicDisplayO 

绘制 实时 控制 曲线 ， 侍 隅 10 个 采样 向 期 执行 一 次 ， 每 次 绘制 10 个 只 。 界 血 采 取 方 框 的 
形式 ， 由 jine(0 所 数 实 现 ， 每 五 个 忠 共 用 -个 横 从 村 ， 每 冰 20000 个 点 清 胖 一 次 。 

中 斯 喝 应 是 实时 控制 中 最 重 此 的 部 分 在 本 程 译 中 ， 中 断 响 应 响 数 IniTimerO、 
interruptO 和 TirqHoeokO0) 来 实 更， 中 断 时 问 为 Ims， 在 中 断 时 间 内 守 成 控制 算法 及 绘 网 等 功能 ， 
采 骨 定时 器 8253 模 式 米 实现 中 断 , 沾 断 控 制 器 采用 8259A 模式, 中断 参数 在 头 文件 chap11_3. 
中 设 定 。 分 草 介 绍 如 下; 

鲁 IniTimer0 

守 现 中 断 初始 化 ， 问 8253 定时 器 中 汪 入 控制 字 ， 采 用 工作 方式 3，- :过 制 计数 ， 进 用 计 
数 寄 存 器 0， 先 让 低 8 位 再 读 高 8 位。 CPU 时 钟 频 效 为 1.193MHZ 

鲁 TinmelIIrqYectO) 

中 断 服务 程序 ， 竺 个 采样 周期 执行 -次 完成 的 任务 为 : 计算 实时 时 间 : 调用 Controlg 
实现 控制 律 ， 调 用 Write_DAO 将 控制 信号 送出 ， 调 用 DataSavedRoutine0 存 数 ， 每 隔 10 个 采 
样 周 期 将 师 风 标志 位 置 1， 发 8259 中 断 管 理 器 选 通信 号 。 

量 [rqHookO) 

实现 中 断 地 址 公 持 、 即 保存 旧 的 中 断 向 旺 ， 设 器 新 的 申 断 间 量 。 

鲁 “ReleaseHardwareO) 

恢复 旧 的 中 新 向 量 ， 调 用 Write_DA0 输 出 鹤 控 制 信号 ， 实 筑 控 制 电机 的 清 零 。 





算出 识 羌 ， 





利川 PID 控制 算法 算出 控 











11.2.3 ”仿真 程序 及 分 析 


仿真 实例 
《台中 懂 为 一 阶 传递 函数 : 
GO= 一 0 
+605+1770 


采样 时 间 为 Ims， 离 散 化 为 : 
=1.94y(E-D-094r(-2) 二 0.0008674x( -+0.0008503w(K ~ 
channel 利 | Signal 框 选 私 输入 信号 类 型 变 地 ， 其 怕 channel=1 为 转台 中 框 ，Signal=1l 为 正 
区 和 葵 入 信号 ， 其 为 0010， 频 率 为 050Hz。 采用 PD 进行 位 置 跟踪 的 实时 控制 ， 其 中 
三 =104 =10， 省 厅 =1 时 ， 信 自信 号 南 D/D 板 采集 而 得 ， 为 PID 实时 控制 ， 当 M = 2 时， 
位 置信 号 由 传递 琢 数 给 出 ， 为 PIP 仿真 控制 。 位 置 跟 跌 结果 实时 控制 如 图 11-6 所 示 。 
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图 116 位 置 虹 院 实 时 控制 结 末 


rectoxryY 









)JcrVborlanacVinc 


<piach .h> 





fg clLrscri) ana ger 








clude 





#imcloude EinkrEl 





lude <Gos.h 





anG _Snable1) 
Winclude <scring .py> 


#inclw keyi) 





OF 








hdeftline LPGTLD 

ydaefine T 5$00 

tdefine DD_PORT 0x380 D/D base addreee 
int ch 03irmeri 








inC Sigrnal=2: Si9mal 


double PositionConmanalTIMER_RATIO 





Goubie Linei 





gouble Curr 





douplie Line2[TT 











bar 
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aouble Pi-3.141592653589791; 

aouble imezt=0; 

int flag=0; 

unsigneqa short UpaateFlag=01 

douple mstep,mstep_1,Scep,Savestep-0; /AmStep_i1(ty=mStep(t-10) 
/Amstep must defineq double 


unsigme 包 Short 了 七 nuUrm7 
unsigned short TimerCount; 
unsigneo Tong Counter 


unsigneQ Short fl1agF57 
UnsigneG Short 丰 LnishSirmulaat 人 7 


FIDE *xyz， 


#define DD_PCORT 0Dx380 7Z7Inner Erare 
woiQe ResetShuXiarBiaot ) 
{ 
Ourporr (DD_PCORT ,0xX0) : 
OutPort(DP_PORT ,OOxXE) 1 
OutPEort (DP_PORT+4 0xD) 7 
OutPort (DD_RORT+4 ,0xE) 
oucporc (DD_PORT+8 ,0x0) : 
outporbt (DD_PORT+8 ,9xE] ; 


double angle_1; 
double ReadD_D(unsigned short channel) 
工 
unsignead short Data_H1,Data_L1,Data_H2,Data_L2; 
long int datayangle_degreeyangle_minuLe,angle_secondi 
aouble angle,anglel,errory 
aqo 工 
Data_L1=inporrtDD_PORT+4*cnamnnel) 了 
Data_H1=inport{DD_PORT+2+4xChanneljy 7 
Data_L2=inport{DD_EORT+4*charnel)7 
Data_H2=inporE (DD_PORT+2+4*chanrmel) 7 
jwhilet(Data_L1I=Data_L2)11(Data_Hl1=Pata_H2)) 17 


data=((Data_H1 & 0Xx3f]*65536+Daca_L1) 7 
anSlel=aata*0.97 /Seconqd Per dataa 





x80) /Anagarive E Data 也 .了 





if((Dakta_H1 & 0xB0) 
anglel-=-anglel; 
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ang1le=anL1el73600.07 7AChange Erom Second to degree 
returnfangle) 


#qefine Da_BoarQ 0x1A0 

voida WFite_DRtdouble qValue，int channe1) 

{ 
unsigned int hiy low,hilowy 
nt Satey 
Qouble voltagey 
voltagSe=dValue 
iffvoitage>2.0)voltage=2.0; 
if(voltage<-2.0)Vvoltage=-2.07 
hilow= (unsigned int)({Voltage)*65535720) 7 


hi=hilcow&0xft007 
Phi=hi>>8y 


Tow=hilow&Dxff+ 


outportb(Da_Board+rD, channel); /7/Select channel 


ao 

{ 

State= (inportb(Da_Board+0))&Ox801 

} whilelstate==1)7 /Aread bit D7; 1E D7=0 write Gata 
outportb(Da_Board+1, low); 7/VwTite 1ow byte 
outportb(Da_Board+2,hi)， 7Awzrite hitgh byte 
outportb(Da_BoarG+3,0) 1 77estart da 


int KbGetKey (int *ScanCoqe 
{ 

nt KeY: 

int KeyCoder 

Key=bicoskey (0) 7 

E{ (Key&Ox0O0tf)==0) 

{ 

KeyCode=0; 

vScanCode= (Key>>8)&127; 

) 

else 

人 
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KeyCoQe=KeyE&0xEi 
*ScanCoae=01 


] 
Tekrurn (KeyCodqe) 


int SavedF1ag,SaveCounteT1 
void SetupKeyReacciontvoid) 
{ 
int Key ,Scan 
工 丰 (kbhitt) ) 
攻 
Key=KbPGetReYy (&Scanmn) 7 
E (KeYy==KXB_C_N_F5 && Scan= 








KB_S_N_F5)》 


上 
SavedF1ag=17 
SaveCounter=0i 


了 
1 (Key==KB_C_RA_X && Scan==KB_S_A_X) 


{ 
FinishSirmulate = 十: 


double huge Datasaved[DRATR_PIMENTION] [DATA_LENGTH] 
voida DatasaveRoutine( 1ong int SaveSpan) 
开 

iftSavedFl1ag==1) 


工 


if((SaveCcounter<=SaveSpan*DATR_LENGTH) ) /ADATR_LENGTH is Defineq by 


chapl1l_3 ,n 
开 
int SaveIndex = SaveCounter/SaveSsPan7 
/VSave datalrin,yout) Oo xyz.Qat 
Datasaved[0] [SaveIndex]=PositionCermand1[ It 上 eTINUm] ; 
Datagsaved[1] [SaveIndex] =CurrentPosition[IEemNumj 


了 


SavweCOuTEeTT+ 二 1 
if (SaveCounter>=SaveSpan*DRTRA_LENGTH) { SavedF1ag-07 SaveCcounter=07 } 


] 


if(SavedFlag==0) SaveCounEer=01 
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int MD 


double yout,errcor ,derrori 





double u_l1=0,u_2-0,y_1=0,y_2=0,error_l=0,error_2=0,ei=0l 


Gouble Contrel taouble rin,unsigrned Short chanmnel) 





/17Realtime conkrol 


Yout=ReadD_D (channe1) ; 77Read realtjime QQata 
CurrentPosition[ItermNum]=yout 

] 

空 E【 
{ 
yout=1.94xy_1-0.94*y_2+0.0008674*u_1+0.0008503*U_27 
了 





) 77Simulation Contrecl 


CurrentPosition[ItemNum]=youti 


yout=CurrentPosition[IEemNum]: 


F=D.S0; 
R&A=0.0107 iffa==0.0) { A=0.0001; ) 
工 iD = 及 *Sin(FY2xPirytireZc) 了 


error-rin-yout 1 


U=10.0*error+1 .0xQerrGr+Orx 所 ii 
ZUpdatre ParameterS 


try_1=yocuti 





1LFu_Lr 





errOr_23=error -17 


ErrOIT 1=eror7 


return Li 
了 
int Cycles-=5; /1/Display cycle 上 imes 
void DynamicDisplayf) 
上 

AMaKe 己 winaow 

cnar StraI50] 7 

int ,SPpeint: 

int bettom,miadle,top,right,1eft) 
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bottom=3007midaie=-200;top=100;1eft=50;right=5507 
setcolor (RED) ; 

outtextxy(270,50, "PITD Controller") 

1ine(left ,top,1eftt,bottorm) Z7lLinelett 
SPIrintE(StYR， "和 ERAx6.075.0)7 
outtexcxy(36,Lop-10， SETR) 7 

1ine(lefL,Eop,Iight, op)> ZLinetop 
outtextxy(t36,middle,*0") 7 
1inetleft,midadle,right,miaadle)7 7ALinemiqale 
Sprintf(strA，" 和 af"，-Ae6.075.0) 1 
Outtextxy(36,bortom+5,StrRA); 
1ine(Left,pottom,right,bottom); /7/Linedown 
1inetright,top,zight bottom) AZALineright 


VANHake Curve Range 
for(i=0;i<TIMER_RATIO)i++) /7/PLot 10 points once a ime 
{ 
Spoint=mSEep_1/Step-TIMER_RATIO+i 7 /7/Start Doint 


Spoint-=Spoint/Cycles; /1/20000/(10*T)=One Cycje 
守 (SPoint 务 T== 人 0) 
人 

clrscr tj 
》 
PutpixelfSpoint-(sSpoint/T)*T+50,-100*5.0/6-0+ 


(Linet [ily7aA)+200,BDUE) VBPractical Output 
PutpixeltSpoint-(SpointyT)*T+50,-100*5.076-0* 
(Line2[i]7Zai+200,RED》 了 ZA/Iaeal Cutput 


Putpixel (Spoint-(Spoint AT)*T+50,-100*5-075.0* 
+200,BLRACI) 7/centrol output 


) 


void IniTimer( unsigned char timer_moae ) /Iaitial 8253 
{ 

unsigmned char Valuer 

_daisablef) 7 


/VSetting control word 
OUTPORT (TIMER_BASE+3,cimer_mode) 
value = TIMER_VALUE /ALow 8 bits 
OUTPORT ( TIMER_BASE ，vValue ) 
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value = TIMER_VRALUE / 256 ; /7/Hignh 8 biks 
OUTPORT( TIMER_BRASE ，value ) 7 


_enab]lef)7 
了 
void interrupPt ({ *DlaIrqvVect )( CPPRARGS ]， 
woid interrupt TimerIrGVect( -CPPARGS ) 7Y7InECruUPL PrOceSSsnG 


{ 
unsigmned short 1 
_aisable()z 
ILermNum = CountergsTIMER_R&TIOF 


ifitCounterg%20000==D) 

人 

CounteIT=Q 

SaveStep=SaveSEep+mStep 

mSEep=0y 

] 

mStep += Step: ZKkxts: TIMER_CYCLE /TIMER_RRTIO7 


E (Sigmnal==1) 7/Dymnamic Signal 
{f Positioncommand [TtermNurm] =axsinfF+2xpirmStep); 】 


】》 77AStatic Signal 





E {Signal: 
{ ， PositionCormmana[IterNum]=A; 】 


ur=ControlfPositionCommnandiItemNum] ,channel) 


Write_DR(u,channel) 


DataSaveRoutine(1) 7 


Counter++ 了 





ift(--Timercount)==O) 7yUpdating 1 times while interupted by 10 times 


UpdateFlag=11 





mStep_1=mstepy 
TimerCount=TIMER_RRTIO: 


了 
OUTPORT(EOI,0x20); /7/OCW2 value:0010 0000 


_enaple() 


voiairqHooktunsigned short irqnumber, void interrupt ( *newvect ) (一 CPPRRGS ) ) 
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_aieablet): 
OldIraVect = getvect ( irgmumber ) 
setvect ( irqnumber ，neywvect ) 


_enable() 


voidQ ReleaseHardwaret) 


{ 


_Gisable() 7 

Setvect (Irqnumber,OldIraVect) 7 
Write_DaAIO.D0)7 
WIFIYEe_DRAIO.0,，1) 7 
WIFIEe_DRALO .0 2)7 


_enablef] 


maimfvoia) 


int jj,K; 

unsigned char timez0_moqe, Strtime[10] 7; 

int ariver,meae: 

ariver=DETECT 

initgraph(&driver,Smode，"") 7 

timer0_mode=T8253_MODE_31m8253_CHRANNEI_01 
T8253_BIN_MODEIT8253_LOW_FIRST; /18253 timer Setting 


Step=TIMER_CYCLE/TIMER_RATIG; /7/8tep=0.01/710=0.001s=ts 
mStep=01 

mStep_1=07 

Counter=01 

TimerCounc=TIMER_RaTIOY 


CIrSCE() 


ResetShuXianBiaot) 7 


/AUsing nEerupt Eunction 


TniTimer(timer0_mode); /7/8253 timer Setting 


ITrqHook(Irqmnumiper,TimerTraVect) 


WhilefT) YAZ1 S 七 XUe 


{ 
timezt=SaveStep+mStep: 





if (UpdateFlag==1) 

{ 
UpdateFlag=07 
for(i=0ii<TIMER_RATIO;i++) 
{ 


Line1[Ii] 





PositionCommanQ[i]: 
Line2fi]=CurrentPosition[i]; 
】) 

SetupKeyReaction 1 ; 

Pynamicpisplayf) 1 


SPYinLE(LStTtirme，" 和 fimezt) 7 
bar{260,380,360.360)7 
OutLextxy (285，385，"timets)") 7 
OuttextxYy (280 .370,，StrEimej)i 


7 了 E(kbhitt)) ( break; ]】 /7/Break byY any Key 
E(FinishSimulate==1) 7ABTeak DY “RATT+X" 
Dreak7 
}7AEna of forf) 1Loop 


7//Open xxz.dat for Save data 
让 【(xyz = Fopent"xyz.aat"，"wr))== NULD) 
{ 
Printf(t"Cannot open cutput file xyz.Qat-An")7 
exitt 1 3 
了 
7/XYZ=fopent"3y2.-dat" now") 7 


fort i=0;i<DaATR_LENGTH7I++) 

ff 

forf j-0; j<DRTRA_DIMENTION; j++) 
{ 
fprintt(xyz,”%10.5f ",DaraSavedfj]l [il)1 
了 

fprintf(xyz "An") 

了 


FEclosefxyZ) 了 


ReleaseHardgwaref);  //Clear all output 
getchf); /APRny key to exit 
，465。 





Cl1osegraph() 


/7/Restores the original viaeo mode Getecteq by initgraph 


Festorecrtmode1l): 


Teturn 0 
}】 YEnd of mainf1] 


参数 楚 始 化 程序 ，chap11_3.h。 


#qefine 
#Qefine 
#Gefine 


#Ge 下 于 所 


#QefEime 


TIMER_BRASR 0x40 /ATimer base address 

TIMER_RRTIO 10 /7Display cimer rate 

TIMER_CYCLE 0.001*TIMPR_RATIO /VDisplay time cycle 
TIMER_VRALUE 1193 /77/Define interupt time:sarmpling timetts=0.0013) 


Iraqmumber 0x08 


/VSave data Parameters 


#define 
#Qefine 


DRTR_DIMENTION 
DaTRA_LENGTH 


77A8253 七 imeT 


#QeEILne 
##Ge 上 De 
#QefIne 
#qefine 
#QeFine 


#QeE ine 


#Qefine 
#qefine 
#QGeEIne 


#Gefine 
#QGefine 


#Qef ne 
#Gefine 
并 Ge 工 ine 
#qdefine 


T8253_MODE_0 
T8253_MODE_T 
T8253_MODE_2 
T8253_MODR_3 
T8253_MODE_4 
T8253_MODE_5 


T8253_CHANNEL_0 
T9253_CHANNEL 1 
T8253_CHANNEL_2 


T8253_BIN_MODE 
了 8253_BCD_MODE 


8253_COUNT_LOCK 
了 8253_COUNT_LOW 
T8253_COUNT HI 
T8253_LOW_FIRST 


7/8259 controlfP1971) 


#Qefjine 
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EOI Dx20 


7ARealtime interupt kind:Clock InteruPt 


ZL/Define key value7A 


##Gefine 
#dqefine 
革 QefEime 
#Qefime 
#Qefine 
#define 


KB_C_N_F4 0 
XB_S_N_F4 62 
KB_C_N_F5 0 
KB_S_N_F5 63 
KB_S_A_X 45 
KB_C_RA_X 0 


#ifdqef __cplusplus 


#define -CPPRRGS 


村 emdi 下 
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